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Filename: <*%&Bft£B> (AutoSplit) 
Description: 

The functions in this file will perform the required operations 

for controlling drivel ine components on the J 1939 communication link. 

Part Nunber: <none> 

SLog : R : \ash i f t \vcs\dr l_cmds . c9v $ 

Rev 1.9 25 Feb 1994 16:07:40 schroeder 
Removed predip's (experimental) BIN 8 ramp off rate- -no longer needed. 
Added condition to predip's torque bumps: timers are frozen until 
actual engine_pct trq responds. Important when engine brakes are on. 
Hade RECOVERY_STEP_TABlE£J a constant value—all ratios used 8%. 

Rev 1.8 21 Feb 1994 15:07:26 schroeder 
Replaced shi f tabi I i tyjnode with new flag, engine_brake_avai lable. 

Rev 1.7 03 Feb 1994 15:57:28 schroeder 
Added setting of command_ETC1 to each command function, enabling 
overspeed during control~engine_predip( ) and control_engine_sync() and 
disabling overspeed during all others. 

Rev 1.6 17 Nov 1993 09:50:10 amsallen 
In the initiate function, net_engine _pct_trq was replaced with 
act_engine_pct_trq since desi red_enginejxt_trq values are in indicated 
power not net_power. Also the sync_timer timeout was reduced to 100 for 
down shifts and 200 for upshi f ts(l"second and 2 seconds) rather than 200 
for all shifts. Also the delay at 0 torque after a time out was increase 
from 150msec to 250 mesec. 

Rev 1.5 04 Nov 1993 09:16:08 schroeder 
In RECOVERY_STEP_TABLE [] , restored the value for sixth gear to 8%. 

Rev 1.4 02 Nov 1993 09:40:06 schroeder 
Replaced demanding ine_pct_ trq with pct_demand_at_cur_sp. Engine 
speed limit during torque limit operation changed from high idle to 
8031 rem, as suggested in J 1939/71. 

Rev 1.3 11 Oct 1993 14:22:40 schroeder 
Removed cruise_control_act ive flag; replaced accel pedal with 
demanding i ne _pc t _ t rq . 

Rev 1.2 22 Sep 1993 10:48:22 amsallen 
The function control engine sync was changed to resolve OR 3235ma08.deb, 
clunky low throttle high range shifts. The engine target now moves above 
sync when input _sp«ed - sync < 40 rpa and transmission position * engaging 
rather than just tp » engaging. Set OR 3235ma08.deb for additional details. 

Rev 1.1 01 Sep 1993 14:09:52 schroeder 
In control_engine_sync, modified dither to insure that the engine 
target stays below sync for a range shift. Also, the dither amount 
increases from 35rpm to 100rpm, then repeats. 

Rev 1.0 29 Jul 1993 16:40:40 schroeder 
Initial revision. 



* Header files included. 
* 

# include <exec.h> /* executive information V 



Ilnclude <c_regs.h> /* KB internal register definitions V 

tf include <vw«lib.h> /* contain* camon global define* */ 

iinclude °cont sye.h* /* control systes information */ 

#include "con j 1939. h» /* define* interface to j1939 control module V 

iinclude M drl_ooo*.h» /• drive line contends information */ 

tinclude "trn^tbl.h" /• transmission table data structures */ 

tinclude u sel~gear.h» /* access to speed filter values */ 

iinclude "calc.spd.h" 

iinclude "trns~act.h» 

fpragma noreentrant 
* ^defines local to this file. . 



#define USJ>ER_LOGP 10000U 

#define ACT I VE_RECOVERY_GEAR 10 /* rule out boosting downs for now V 
* 

* Constants and variables declared by this file. 

************************************************************************/ 

/* public */ 

register uchar engine^comnands; 

register uchar engine_status; 

uchar desired_sync_test_mode; 

/* uint desired_eng_spd_new; */ 

/* uint desired_eng_spd_delta; */ 

/* uint desi red_eng_spd_di f f ; */ 

ui nt des i red_eng i ne_speed_test; 

ui nt des i red_eng i ne_speed_ramp; 

uchar desired_engine_speed_timer; 

uchar des i red_eng 1 ne_speed_t i me ; 

uchar eng_brake_command; 

uchar eng_brake_assist; 

uchar posi t i vej>edal_trans; 

uchar sync_f i rst_pass_timer; 

uchar clutch_state; 

uint clutchTslip^speed; 

int dos_f iTtered; 

int over a I l_error; 

unsigned int os_based_on_rcs; 

unsigned int input_speed~f i Itered; 

unsigned long is_f Utered~bin8; 

unsigned int output_speed_f i I tered; 

unsigned long os_f i ltered_bin8; 

signed int input_speed~ accel_f i I tered; 

signed long dis_f i ltered_bin8; 

char eng_percent_torque_f 1 1 tered; 

char percent_torque_eccessories; 

char needed^percent^for^xero^f lywheel_trq; 

uchar zero_f lywiieel^trqjtiiier; 

uchar zero~f lywheel^tro^lfne; 

uchar accelerator j3edal_position_old; * 

int input^shaf t_accel_calculated; 

uint gos; ~ /* overall destination gear ratio * output speed BIN 0 */ 

int gos_signed; /* overall destination gear ratio * output speed BIM 0 V 

uint gos_current_gear; /* overall current gear ratio * output speed BIN 0 */ 



unsigned char sync_f irst_pass; 

unsigned int syrcjwintain_tiiner; 

signed int sync_offset; 

signed int sync~dos_of fset; 

signed int sync_dos_offsetJC1; 

signed int sync_speedjnodif ied; 

unsigned char intent_to_shif t; 

char intent~f tnal_pct_trq; 

char intent_ramp_off_rate; 



/* local */ 



static uint pradfp_tia*r_1; 
static uchar pradlp.tiaar.?; 
static uchar pr«dfp~tiatr_3; 
static char predip.Jorqua.btfp.vaivja 
static uchar pradi p_t orqua_bunp_t i m 

static uint sync_on_t intr; 
static uint aync'of f_tio»r; 
static uchar sync_di thar_tiner ; 

static uint tdrque_l imit; 
static uchar recovery_cancal_timer; 
static uint recov_coast_do«n_tmp1 ; 
static uint recov~coast~down~tmp2; 

static int dgos; 

static int tpf_output_accel; 



#pragma EJECT 



PREOIP MOOE CONSTANTS 
A**************************************** 



iu.i:„ DDCftfD 7CDA CnOV TIME 


*U 


/* 


u.hus alums per i oa 


/ 


#v€Tine rKCUir IUKUUC l tnc 




/ 


u • ou s» si unci I i w 


*/ 

* 


#define PRED I P~NORMAL*T ltt~ 


200 


/* 


2.00s 3 10ms period 


V 


tfdcfine TOROUE_RAMP_0?F_RATE 


1 


/* 


U (per loop) V 




#define PREOIP TORQ BUMP VALUE LO 


0 


/* 


OX */ 




tfdefine PREDIP~TORO~BUHP~TIME_L0 


15 


/* 


0.15s 310ms period 


*/ 


#dcfine PREDlP_T0R0 BUMP_VALUE_MED 


5 


/* 


5% */ 




#def ine PREDIP~T0RQ~BUMjOlME_MED 


25 


/* 


0.25s aiOras period 


V 


^define PREDIP TORQ BUMP VALUE HI 


10 


/* 


10X */ 




#define PREDIP~TORo"buMP"tiME_HI 


30 


/* 


0.30s 310ms period 


V 



SYNC HOOE CONSTANTS 



#define SYNCJ)ITHER_TIME_ABOVE 
^define SYNC~0iTHER~T IME~BEL0W 
#define SYNCJ)ITHER~RPM " 
#define SYNCED ITHER~F I RST_TIME 

#define MAINTAIN SYNC TIME 

#define SYNC FIRST PASS TIME 

#define THREE PERCENT 

#define ENG RESPONSE UPSHF TIME 

#define ENG RESPONSE 0NSHF TIME 

#define SYNC DOS OFFSET CONSTANT 



20 


/* 


0.20s a 10ms period 


*/ 


30 


/* 


0.30s a 10ms period 


*/ 


35 


/* 


35 rpra 


V 


255 


/* 


DUMMY VALUE 


*/ 


500 


/* 


5.00 Sec 


V 


250 


/* 


2.50 Sec 


V 


3 








10 


/* 


10 msec 


*/ 


10 


/* 


10 msec 


V 


2816 


/* 


11 BIN 8 


*/ 



RECOVERY MO0E CONSTANTS 



JSWefine RECOVERY CANCEL TIME 10 

Jfcjefine RECOVERY CANCEL OFFSET 20 
define RECOVER Y~TOROUE STEP 1280 

#define THL0 OS ENG DECAY K1 450 

#define THL0~0S~ENG~DECAY~RAMP 1 

#define THL0J)S~FInTshED_DELTA 200 

static const uint RECOVERY RATE TABLE (23] 



/* 0.10s aiOms period */ 
/* 20X BIN 0 */ 
/* 5X BIN 8 V 

/* 1 rpm BIN 0 */ 
/* 200 rpm BIN 0 */ 



o, 


/* 


-4 


*/ 










o, 


/* 


-3 


*/ 










128, 


/* 


-2 : 


0.50X 


per 


loop BIN 


8 


V 


128, 


/* 


-1 : 


0.50% 


per 


loop BIN 


8 


V 


128, 


/* 


0 : 


0.50% 


per 


loop BIN 


8 


V 


128, 


/* 


1 : 


0.50% 


per 


loop BIN 


8 


V 


128, 


/* 


2 : 


0.SOX 


per 


loop BIN 


8 


V 


128, 


/* 


3 : 


0.50X 


per 


loop BIN 


8 


V 


128, 


/* 


4 : 


0.50% 


per 


loop BIN 


8 


V 


192, 


/* 


5 : 


0.75% 


per 


loop 8IN 


8 


V 


1°2, 


/* 


6 : 


0.75X 


per 


loop 8IN 


8 


V 


1°2, 


/* 


7 : 


0.75X 


per 


loop BIN 


8 


*/ 


281, 


/* 


8 : 


1.10% 


per 


loop BIN 


8 


*/ 


281, 
281, 


/* 


9 : 


1.10% 


per 


loop BIN 


8 


V 


/* 


10 : 


1.10% 


per 


loop BIN 


8 


V 


o, 


/* 


11 


V 










0. 


/* 


12 


V 










o, 


/• 


13 


*/ 










o, 


/• 


14 


•/ 










o, 


/* 


15 


•/ 










o, 


/* 


16 


V 










o. 


/* 


17 


V 










0 


/* 


18 * 


/ 











* Function: ini t ial ize_drivel inedata 

* Description: 

* This function, called after all resets, will initialize the system 

* copy of drivel ine related data received from the communications link. 



static void initialize drivel ine data(void) 
( 

accelerator_pedal ^position * 0; 
engine^cofrmunicati on_act ive * FALSE; 
engineer a ke_avai I able » FALSE; 

eng_brake_conmand * ENG_BRAKE_IDLE; /* should init with engine_coninands 

clutch_state = ENGAGED;' 

positive _pedal_trans » FALSE; 

zero_f lywheel_trq_timer ■ 0; 

zero_f lyvheel_trq_time 3 0; 

percent_torque_accessories = 3; 



desired_sync_testjnode 0 FALSE; /* debug use only 

desired_engine_speed_test * 0 ; /* debug use only 

desired_engine~speed~ramp 3 0 ; /* debug use only 

desired_engine_speed =0; 
/* des i red_eng_spd_new =0; */ 
/* desired_eng_spd_dif f » 0; */ 
/* des i red_eng_spd_de 1 1 a = 10; */ 

desired engine speed timer = 0; 

sync_dos_offsetJCl **SYNCJ)OSJ)FFSET_CONSTANT; 

desired_engine_speed_t ime = 0; 

intent_to_shif t = FALSE; 

intent_f inal jxt_trq = 0; 

intent_ramp_of f_rate = 1; 



delete 
delete 
delete 



later 
later 
later 



*/ 
V 
*/ 



> 



ffpragma EJECT 



* Function: control_engine_pfedip 

* Description: 

* Determines throttle command for predip mode. 
* 

* After a reasonable delay for the transmission to pull to neutral the 

* torque will be cycled from zero to a determined value to help the 

* transmission achieve neutral. 
* 

static void control engine_predip(void) 
( 

if (engine status != ENGINE PREDIP MODE) 
C 

engine_status = ENG I NE_PRED I PJWDE ; 

predip_timer_1 = 0; 
predip~timer~2 = 0; 
predip_t imer_3 = 0; 

if (actual engine_pct trq < 5) 

predipjtimerj = PRED I P_N0RMAL_T I ME ; 
else 

desired engine_pct trq * actual_engine _pct_trq; 

> 

engine control = TORQUE CONTROL; 
command_ETCl * C_ETC1_0VERSPEED; 

if (predip timer 1 < PREDIP NORMAL TIME) 
i 

if ((desired_engine_pct_trq >= TORGUE_RAMP_OF F_RATE ) && 
(actual engine_pct trq > 0)) 

C 

desired engine jxt trq -= TORQUE RAMP OFF^RATE; 

> 

else 

desi red_engine_pct_trq = 0; 

/* check to force bump if neutral not achieved */ 

if (actual engine _pct trq < 10) 

i 

if (++predip timer 3 >= PREDIP ZERO_FDBK_TIME) 
predip timer 1 = PREDIP NORMAL tTmE; " 

> 

> 

♦♦predip timer 1; 

> 

else 
i 

if (Clpf output accel > -150) && 

CpredTp timer 1 < (PREDIP NORMAL TIME ♦ PREDIP TORQUE ZERO TIME))) 

C 

predip torque bump tine » PREDIP TORQ BUMP TIME LO; 

predip~torque~buap~value « PRfDIP TORQ BUMP VALUE J.0 ♦ needed j*rcent_for_zero_f lywheel_trq; 

) 

else . 
i 

if (predip timer 1 < (PREDIP NORMAL TIME ♦ 2*PREDIP TORQUE ZERO TIME)) 
< 

predip torque bump time ■ PREDIP TORQ BUMP_TIME_MED; 

predip~torque~bump~value » PREDIP TORO_BUMP VALUE MED ♦ needed j*rcent_for_zero_f lywheel_trq; 

> 

else 
( 

predip torque bump time * PREDIP TORQ BUMP TIMEJU; 

predip~torque~bump~value * PREDIP TORQ BUMP VALUE HI ♦ needed j*rcen t_f or_zer o_f I ywh eel _trq; 

> 

> 

if (predip timer 2 < predip torque bump time) 
i 

desired_engine _pct_trq = pr ed i p_ t o rque_bunp_va I ue ; 
if (actual engine_pct trq > 0) 



♦*pr«dfp_t1«tO ; 

> 

> 

C 

des i red^eng i ne_pct_t rq ■ 0; 
♦+pred i p_t i oer_1 ; 
♦♦predip tiwr~2; 

> 

if <pred!p_tin»r_2 >• PRED ! P_TOROUE_ZERO_T I ME ) 
predip_tim*r_2 » 0; ~ 



> 

tfpragma EJECT 



* Function: control _eng i ne_sync_ L ever (AutoSplit) 

* - — - 

* Description: 

* This function synchronizes engine speed to output shaft speed 

* during a shift. 



static void control engine sync lever(void) 

C 

if (accelerator j*dal_posit ion > THREE PERCENT) 
sync_maintain_timer 3 MAINTAIN_SYNC_TIME; 

if ((engine status I* ENGINE SYNC MODE) || (sync maintain timer « 0)) 

sync_on_t imer = 0; 
sync_of f_timer = 0; 

if (engine status 1= ENGINE SYNC MODE) /* first time through sync */ 
( 

sync maintain timer = MAINTAIN SYNC TIME; 
engine status"= ENGINE SYNC MOOE; 

) 

else /* sync maintain timer reached 0 */ 

i 

engine control - OVERRIDE DISABLED; 
conmand ETC1 * C ETC1 NORMAL; 

> 

> 

else 
( 

syncjna int a i n_t i mer- - ; 

if (sync on timer** <= 296) /* allow sync mode for about 3 SEC */ 

sync_of f_timer = 0; 

engine control = SPEED CONTROL; 

conmandJTCI * C_ETC1 J)VERSPEED; 

if (shift type == UPSHIFT) 

sync offset = -65; /* RPM */ 

> 

else /* shift is a downshift */ 
< 

sync offset * -65; /* RPM V 

) 

if (gos signed * sync offset > 0) 
( 

/* desired_engine_apeed » (int)(sos_signed ♦ sync_offset); V 

cx = dosjiltered; /* BIN 0 */ 

~bx » trnTtbt.gtw ratiotdestfnation gear ♦ GR 0FS]; /* BIN 8 V 
"ax * sync dot offset K1; " /* BIN 8 V 

asm mul _cxdx,~_bx; " /* BIN 8 V 

asm div "cxdx, "ax; /* divide by constant BIN 8 */ 

sync_dos~of f set~« _cx; /* save final result BIN 0 V 

desired_engine_speed » (int)(gos_signed ♦ sync_offset * sync_dos_of fset) 

#if (0) 

des i red_eng_spdjtew » ( int)(gos_signed ♦ sync_of fset); 

if (desired_eng_spd_new > desired_engine_speed) 

desired_eng_spd_dTff « desired_eng_spd~new - desired_engine_speed; 
else" - " 

des i red_eng_spd_d i f f » desired_engine_speed - desired_eng_spd_ne«; 

if ( des i red_eng_spd_d i f f > deslred_eng_spd_delta) 
desired engine speed « desired eng spd new; 

#endif 



•Is* 

desired engine speed * 0; 

> 

else 
i 

if (sync off timer <» 4) 
< 

sync off timer**; 

#if (0) 

engine control » TORQUE CONTROL; 
conmand_ETC1 » C_ETC1J)VERSPEED; 

desired'engine _pct trq ■ needed ^percent for zero f lywheel_trq; 

#endif 

> 

else 

sync_on_ timer * 0; 

> 

> 

> 

#pr agma EJECT 



* F met ion: control _eng i ne_sync_aut o (AutoSpiit) 

* — ~ 

* Description: 

* This function synchronizes engine speed to output shaft speed 

* during a shift. 



static void control engine sync auto(void) 

if (accelerator_pedalj»sition > THREE_PERCENT) 
syncjnaintain_timer s MAINTAIN_SYNC_TIME; 

if ((engine status !» ENGINE SYNC MODE) || (sync maintain timer •« 0)) 
( 

sync_on_ timer = 0; 
sync_off_t imer » 0; 
sync first_pass = TRUE; 

syncj i rst_pass_t imer « SYNC_FIRSTJ>ASS_TIME; 

if (shift_type == UPSHIFT) 

sync_offset » -65; 
else 

sync_offset =65; 

if (engine status != ENGINE SYNC MOOE) /* first time through sync V 

sync maintain timer = MAINTAIN SYNC TIME; 
engine status"* ENGINE SYNC MOOE; 

> 

else /* sync maintain timer reached 0 */ 

C 

engine control * OVERRIDE DISABLED; 
command ETC1 » C ETC1 NORMAL; 

> 

else 
< 

sync jna i nt a i n_t i mer - - ; 

if (sync on timer*-* <= 200) /* allow sync mode for about 2 seconds V 
C 

sync_of f_t imer = 0; 

engine control = SPEED CONTROL; 

command_ETC1 * C_ETC1 JDVERSPEED; 

if (sync firstj^ass " TRUE) 
( 

if (shift type =» UPSHIFT) 
( 

sync speed modified 3 (signed int)( input speed) ♦ 

(input_speed_accel~filtered /(1Q00/ENG_RESPONSHJiPSHF_TIME)); 

if (sync speed Modified < got signed) 

if (sync first _pass timer » 0) 

< 

sync_offs*t • 63; 
sync~first .pass * FALSI; 

> 

else 

sync first _pass timer--; 

) 

> 

else /* shift is a downshift */ 
< 

sync speed modified = (signed int)( input speed) ♦ 

(input_speed_acceO iltered /(1000/ENG_RESPONSEjmSHF_TIME)); 

if (sync speed modified > gos signed) 
C 

/* if (sync first_pass timer »» 0) */ 
/* < " V 

sync_first_pass » FALS€; 

if (pct_de«Bnd_at_cur_sp < 15) 
sync_offset « -65; 



/• > V 
/* %iam */ 
/* sync fir*t_pcss_tiner--; V 

> 

> 

> 

if (gos_signed ♦ sync_offset > 0) 

des \ red_eng i ne_speed ■ <int)(gos_signed ♦ sync_of fset); 
etst 

desired engine speed * 0; 

) 

else 
< 

if (sync off timer <* 4) 
< 

sync off timer**; 

#if (0) 

engine control * TORQUE CONTROL; 
coninand_ETC1 = CJTC1_0VERSPEED; 

desired engine _pct trq * needed_percent for zero flywheel trq; 

#endif 

> 

else 
i 

sync_on_t imer ■ 0; 

sync offset * -(sync offset); /* force sync speed to toggle around gos V 

> 

> 

> 

^pragma EJECT 



/ft ft ft ft < « ft * ftftftftft»ft*ft^ftftftft*ftft**^ftft^ftft*ftftftft*ft^*ft*««*+ft*ftftftftftftftftftft « ft ftft ft < • ft 

* Function: cont r o I _eng i ne_sync (AutoSplit) 

* Description: 

* This function synchronizes engine speed to output shaft speed 

* during a shift. 

static void control engine sync(void) 
C 

if (shift_init_type == AUTO) 
cont ro l_eng i ne_sync_auto( ) ; 
else 

c on t ro I _eng i ne_sync_ I eve r ( ) ; 
intent_to_shift = FALSE; 

> 

^pragma EJECT 



* Function: comrol_tngirw_sync_ttttjDod» (AutoSplit) 

* ™ *" 

* Description 

* This function test the synchronize mode of engine speed control. 



static void control engine sync test mode(void) 
< 

if <accelerator_pedaljx>sition < 10) 
C 

engine status = ENGINE F OL LOWER _MOOE ; 
engine'coninands - ENGINE FOLLOWER; 
engine~control » OVERRIDE DISABLED; 
command_ETC1 » C_ETC1_N0RHAL; 
desired~engine speed » 0; 

> 

else 

if (accelerator_pedal_position > 90) 
< 

engine_status * ENG I NE_SYNC_M00E ; 

engine commands = ENGINE SYNC; 

engine"control = SPEEO CONTROL; 

command_ETC1 * C_ETC1JDVER SPEED; 

des i red'eng i ne_speed = des ired_engine_speed_ test; 

desired~engine~speed timer = desired engine speed time; 

> 

else 
i 

if (des ired_engine_speed_ timer > 0) 

des i red_eng i ne_speed_t i mer - - ; 
else 
i 

if (desired engine speed > 600) 
C 

desired_engine_speed_timer = desired_engine_speed_tiroe; 
desired~engtne~speed~» (desired engine speed - desired_ehgine_speed_ramp) 

> 

) 

> 

> 

^pragma EJECT 



ft*************************** 
« 

* Function: dtttroine^if_recovery_coqplete 

* Description: 

* This routine checks to see if the percent_torque_value_l iai t has 
exceeded the percent_torque_vaLue feecfeack from the engine by xX 
for x milliseconds and will then set percent_torque_value_limit 

* to 100% to cancel the recovery mode. 



* 



static void determine if recovery complete void) 
< 

if <(net_enginejxt_trq > 10) && 

(desired engine_pct trq > (net engine jxt trq ♦ RECOVERY CANCEL OFFSET))) 

recovery cancel timer; 

> 

else 

recovery_cancel_timer = 0; 

if ( ( recovery j:ancel_timer >= RECOVERY_CANCEL_T I ME ) || 
(desired engine^pct trq « 100) ) 

t 

/* terminate the recovery mode */ 

desired engine jxt trq « 100; 

engine status * ENGINE RECOVERY H00E COMPLETE; 

> 



tfpragma EJECT 



• 

* function: c on t ro I _eng \ ne _recovery_nortDa I 

* *" 

* Description: 

* Determine throttle cosnend for recovery mode. 

* T08QUEJ.IMIT is scaled as a BIH 8 number representing the percentage 

* of torque allowed to the engine during recovery. 
• 

static void control engine recovery normal (void) 
< 

engine control = SPEED TORQUE LIMIT; 
co*imand_ETC1 = C_ETC1 JioRMAL;" 

desired_engine_speed ■ 8031; /* torque limit only, max value for speed */ 
torque_limit ♦» RECOVERTJ*ATE_TABLE Cdestination_gear*4] ; /* BIN 8 */ 
desired_engine_pct_trq » (char)(torque_l imit » 8); /* BIN 0 */ 
determine if recovery completeO; 

> 



#pragma EJECT 



* Function: ccmrol_engine_recovery_coasting 

* ~ ~" """ 

* Description: 

* Determine throttle command for coasting down shifts mode. 
* 

************************ ********** A*************************************/ 

static void control engine recovery coasting (void) 
C 

register uint local_uint; 

if (sync on timer <= 300) 
C 

sync_on_t i me r ; 

engine_control = SPEED CONTROL; 
contnand_ETC1 * C_E T C 1 _NORMAL ; 

sync_off_timer = 0; 

/** recov_coast_down_tmp1 * gos ♦ (dgos * K1) - THLOJ)S_ENG_DECAY_RAMP **/ 

if (dgos < 0) /* get absolute value */ 

_cx = (uint) -dgos; 
else 

_cx » (uint)dgos; 

asm mulu cxdx, #THL0 DS ENG DECAY K1; /* BIN 12 V 

asm shrl "cxdx, #12; " ~ /* 8IN 0 */ 

if (_cxdx > 500) /* error check */ 

local_uint » 0; 
else 

localjjint = _cx; 

if (lpf_output_accel > 0) 

recov_coast~down_tmp1 ■ (gos ♦ local_uint) - THL0J>S_ENG_DECAY_RAMP; 
else 

recov_coast_down_tmp1 = (gos - local_uint) - THL0J)S_ENG_DECAY_RAMP; 

/** recov_coast_down_tmp2 » desired_engine_speed - THL0_DS_ENG_DECAY_RAMP 

recov_coast_down_tmp2 « desired_engine_speed - THL0J)S_ENGJ>ECAY_RAHP; 

if (recov_coast_down_tmp1 < recov_coast_down_tmp2) 

desired_engine_speed = recov_coast_down_tmp1; 
else 

desired engine speed » recov coast down tmp2; 

> 

else 
C 

if (sync off timer <« 5) 
< 

♦♦sync off timer; 
engine'control » T Oft CAM CONTROL; 
conmand_ETC1 » C_ETC1 JORKAL; 
desired engin«_pct trq * 0; 

> 

else 

sync on timer » 0; 

> 

if ((desired engine speed ♦ THL0 OS FINISHED DELTA) < gos) 
i 

/* terminate the recovery mode V 

desired_engine _pct_trq * 100; 

engine status » ENGINE RECOVERY M00E COMPLETE; 

> 

> 



#pragma EJECT 



* Function: control_engine_recovery 

* Description: 

* This function determines which type of throttle recovery should be 

* used. And initializes some of the variables that will be used. 



static void control engine recovery(void) 
C 

if ((engine_status »* ENGINE RECOVERY MODE) U 

(engine status 1= ENGINE RECOVERY HOOE COMPLETE)) 

< 

engine_status = ENG I NE_RECOVERY_MOOE ; 
desired_engine_pct_trq = 0; 
recovery_cancel_timer » 0; 
sync_on_timer = 0; 
sync~of f_timer = 0; 

/* kill pedal transition stuff */ 
posi tive_pedal_trans * FALSE; 
posi tive_pedal~trans * FALSE; 
zero_f lywheel_trq_timer = 0; 
zero_f ly*heel~trq_time = 0; 

if (gos < desired_engine_speed) 
des i red_eng i ne_speed = gos; 

/* set initial starting torque limit */ /* percent, BIN 8 */ 

if ((actual_engine_pct_trq > needed_percent_for_zero_f lywheel_trq) && 
( pc t_demand_at_cur_sp > 5)) 
torque_limit = ((unsigned int)(actual_engine_pct_trq))«8; /* percent, BIN 8 V 
else 

torque limit = ((unsigned int)(needed_percent for zero flywheel trq))«8; /* percent, BIN 8 */ 

> 

if ((destination_gear > ACT I VE_RECOVERY_GEAR ) && 
(pet demand at cur sp < 5) && 
((shTft_type == COASTJ)OUN_SHlFT) || 
(shift type == UPSHIFT))) " 

C 

control engine recovery coastingO; 

> 

else 
i 

control engine recovery normal (); 

> 

> 

#pragma EJECT 



^•#4 ftAftj#£ft4t , t*AftAft# A Aft 
• 

* Function: control J ntent_to_shi ft 

* "~ ~* 

* Description: 

* This function 
* 



static void control intent to shift(void) 
C 

if (engine control I* TORQUE CONTROL) 
C 

desired engine_pct trq = actual engine_pct trq; 

> 

engine control = TORQUE CONTROL; 
command_ETC1 = C_ETC1_OVERSPEED; 

positive_pedal_trans » TRUE; /* allow for recovery mode */ 

if (<desired_enginejxt_trq >= intent_ramp_of f_rate) && 
(actual engine_pct trq > intent final_pct trq)) 

< 

desired engine_pct trq -» intent ramp off rate; 

) 

else 
C 

desired enginejxt trq * intent finaljxt trq; 

> 

> 

^pragma EJECT 



ft************************** 

* Function: control_engine_fol lower 

* ~ ~* 

* Description: 

* This function sets the override_control jnode to no over ride so that 

* the engine follows the accelerator demand. 



static void control engine follower(void) 
< 

#define POSITIVE PEDAL TRANSITION TIME 25 /• 250 MSEC V 
#define NEGATIVE PEDAL TRANSITION TIME 40 /* 400 MSEC V 



engine_status = ENGINE_F0LL0UERJ400E; 

if (<intent_to_shift == TRUE) && t 
(shiftJn_process == FALSE) && V 
(desired gear != destination gear selected)) * 

< 

control intent to shiftO; 

> 

else 
C 

if ((accelerator_pedal_position >* 5) && /* positive pedal transition V 
(acceterator_pedal_position old <= 4) && 
(low speed latch « FALSE))" 

i 

pos i t i ve_peda I trans = TRUE; 

zero flywheel trq_time = POSITIVE_PEDAL TRANSITION TIME; 
if (zerojlywheel^trq^timer >= NEGAT I VE~PEDAL_TRANSI T IGN_T IME ) 
zero flywheel trq_timer = 0; 

> 

else 
i 

if ((accelerator_pedal _position <= 4) && /* negative pedal transition */ 
(accelerator_pedal _posi tion old >= 5) && 
(low speed latch == FALSE))" 

< 

zeroJlywheel_trq_time = NE GAT I VE_PEDAL_TRANS I T 1 0N_T I ME ; 
zero flywheel trq_timer = 0; 
> " 

> 

if ((zero_f lywheel_trq_timer < zero_f lywheel_trq_time) && 

(current gear > 1) && (current gear < 10) && (low speed latch =* FALSE)) 

< 

engine control = TORQUE CONTROL; 
commandJTCI = CJTC1.0VERSPEED; 

desired~engine_pct_trq 3 needed^percent^fo^zero^f lywheel_trq; 

if (actual_engfne_pct_trq < (needed _percent_f or_zero_f lywheel_trq ♦ 5)); 
zero flywheel tr^tlner**; 

> 

else 
< 

if ((positive _pedal tram ■» TRUE) U (low speed latch » FALSE)) 
< 

posit ive_pedal_trans * FALSE; 

engine_commands * ENGINEJtECOVERY; /* engine: finish torque return 

control engine recovery (7; 

> 

else 
< 

engine control = OVERRIDE DISABLED; 
command ETC! = C ETC1 NORMAL; 

> 

> 

> /* end no intent to shift V 

> 

#pragma EJECT 



* Function: control^engine^idle 

* — — 

* Description: 

* This function sett the engine controls for the idle mode. 
• 

static void control engine idle(void) 
( 

engine control * OVERRIDE DISABLED; 
command_ETCl = C_ETC1_N0RHAL; 

engine status - ENGINE IDLE MOOE; 

> 



#pragma EJECT 



* Function; com rol_engine_s tart 

* *" 

* Description: 

* This function sets the engine controls for the start mode. 
* 

static void control engine start(void) 
i 

engine control - OVERRIDE DISABLED; 
command_ETC1 » C_ETC1 JIORMAl; 

engine status » ENGINE START HOOE; 

> 



#pragma EJECT 



* Function: cont rol_engfne_conpr«8 ion brake 

* " " 

* Description: 

* This function controls the state of the engine compression brake. 

* The brake can be used coring upshifts to speed up the dec el rate of 

* the input shaft. 

static void control engine compression brake(void) 
C 

if (engine_conraunication active && 

(engine^status « ENgTnE_SYMC_MOOE) && 
(Shifty type =» UPSHIFT) ll 
<input~apeed_f iltered > (gos + 150)) && 
(destination_gear > 1) &£ 
(destination'gear < 7) && 
( eng i ne_brake_ava i I ab I e ) && 

(<dos_predicted < dos _prdtd lim no jake) || eng brake assist)) 

< 

eng brake assist 3 TRUE; 

> 

else 

eng brake assist * FALSE; 

> 



eng brake assist = FALSE; /* force false state for now */ 

> 



tfpragraa EJECT 



* Function: detenu nt_gos 

* ™ 

* Description: 

* This function mulitplies the destination gear ratio times the 

* output shaft speed for use in the DRL_O40$ module. 

* gos » <g)ear * (o)utput <s)peed 



static void determine gos(void) 
< 



/*** determine gos for the destination_gear ***/ 
_bx » trn_tbl ,gear_ratio (destine tion_gear ♦ GR_0FS1; 
_cx » output_speed_f i Itered; /* output speed - */ 
asm mutu _cxdx, _bx; /* BIM 8 result */ 

asm shrl "cxdx, US; /* make 8!N 0 */ 

gos * _cx; /* BIN 0 V 

_cx = *(uint *)&lpf_output_accel; 
asm mul _cxdx, _bx; 
asm div "cxdx, #256; 
dgos * *<int *)&_cx; 

gos_signed = (signed int)(gos); /* allow signed math in other functions*/ 

/*** determine gos for the "current_gear" ***/ 
_bx * trn_tbl .gear_ratiolcurrent_gear + GR_0FS3; 
_cx » output_speed_f i Itered; /* output speed V 
asm mutu _cxdx, _bx; /* BIN 8 result V 

asm shrl "cxdx, MS; /* make BIN 0 */ 

gos_current_gear = _cx; /* BIN 0 */ 



> 



#pragma EJECT 



* Function; deter»ine_shfftabi I ity_var tables 

* ~ ~" 

* Description: 

* This function f liters both the output speed and the rate of change of 

* the output speed for use in the shiftability function. This function 

* also calulates the rate of change of the input shaft based on the 

* filtered value for the rate of change of the output shaft. 
* 

* The filters used in this function are required to get a high level of 

* stability. The BIN 8 filter used here will provide a much smoother 

* output which is needed to filter out drivel ine oscillations. 
• 

* Note: These calculations were placed in this module because it is 

* called on a regular 10 msec interval. These calculations should 

* be placed in the pr_ i_s_t .c96 module once shiftability is proven. 

* These variables are used in the SEL GEAR.C96 module. 



static void determine shiftability variables(void) 
C 



/* LPF coefficients 


: exp(-wT), 


T: 


=0.010s 


V 




#define OS LPF 


248 


/* 


0.9691 


BIN 8 (0.50Hz) 


V 


#define DOSFK1 


249 


/* 


0.9727 


BIN 8 (0.44Hz) 


*/ 


#define EPTFK1 


252 


/* 


0.9844 


BIN 8 (0.25Hz) 


V 


#define IS FK1 


236 


/* 


0.9219 


BIN 8 (0.??Hz) 


*/ 


#define 0S~FK1 


236 


A* 


0.9219 


BIN 8 (0.??Hz) 


V 


#def ine DISFK1 


236 


/* 


0.9219 


BIN 8 C0.??H2) 


V 


#deftne LOU RANGE 


3197 


/* 


3.1224 


8IN 10 


*/ 


^define BIN~10 


1024 











static long dos_f i I tered_bin8; 
static int ept_f i lteredj>in8; 

unsigned long is.f i ltered_partial_1; 

unsigned long is_f i ltered_part ial_2; 

unsigned long os~filtered _partial~1; 

unsigned long os~f i ltered_partial~2; 

/** create lpf_output_accel **/ 



_bx = *(uint *)&output_speed_accel; 
~cx = *(uint *)4lpf.output_accel - _bx; 
asm mul .cxdx, #OS_LPF; 
asm div "cxdx, #256; 
_bx _cx; 

Tpf.output.accel * *(int *)&.bx; 



/* bx = x(n), BIN 0 */ 

/* "cx = y(n-1) - x(n), 8IN 0 */ 

/* cxdx * **(...), BIN 8 */ 

/* make BIN 0 */ 

/* J» « x(n) ♦ **(...), BIN 0 

/* save acceleration */ 



/** dos_filtered = (dos.fi Itered * DOSFK1) ♦ ( Ipf.output.accel * (1-0OSFK1) 



_cxdx * *(ulong *)&dos_f i Itered.binB; 
asm shral .cxdx, #2; 
asm mul .cxdx, #D0SFK1; 
asm shral .cxdx, #6; 
dos_filtered.bin8 » *(long # )4_cxAt; 

cx » *(uint *)&lpf output accel; 
"bx » 256 - 0OSFK1;" 
asm mul .cxdx, .bx; 
dos_f i ltered_bin8 *( long *)&_cxdx; 



/* BIN 8 V 
/* BIN 6 ( cx) */ 
/* BIN 14 V 
/* BIN 8 V 
/* save partial result V 

/* BIN 0 V 
/* 1 BIN 8 * 0OSFIC1 */ 
/* BIN 8 V 

/* sum is final result */ 



dos.fi I tared « (int)(dos_f iltered_bin8 » 8); /* BIN 0 V 

/** eng_percent torque filtered » (eng_percent torque filtered * EPTFK1) ♦ 
(net"engine .pct.trq * (1-EPTFK1) **7 



_cx ■ *(uint *)&ept_f iltered_bin8; 

asm mul .cxdx, #EPTFK1; 

asm shral .cxdx, #8; 

ept.fi Iter ed_bin8 « *(int *)&_cx; 

cx » net engine .pet trq; 
~bx a 256"- EPTFK1; ~ 
asm mul .cxdx, .bx; 
ept.fi I tired.binS *(int *)4.cx; 



/* BIN 8 V 
/* BIN 16 V 
/* BIN 8 V 
/* save partial result */ 

/* BIN 0 •/ 

/* 1 BIN 8 * EPTFK1 •/ 
/• BIN 8 V 

/* sua is final result */ 



/* 


BIN 4 


V 


/* 


BIN 8 


V 


/* 


BIN 12 


V 


/* 


8IN 8 


*/ 


/* 


BIN 8 


*/ 


/* 


BIN 0 


V 


/* 


1 BIN 8 * 


IS FK1 V 


/* 


BIN 8 


V 


/* 


BIN 8 


V 



eng_percent_tortjue_f ! I tared • ( char Kept _f i lttredj>in8 » 8); 

/** input_shaft_accel_catculated « dos_fil tared * gear_ratio **/ 

cx « tm tbl.gearj-atiotdestination gear ♦ GR_OFS]; /* BIN 8 */ 
~bx » *<u7nt *)&do*_ffltered; " /* BIN 0 V 

asm mul cxdx, bx;" /* 8IN 8 V 

asm shraT .cxdx, #8; /* BIN 0 V 

input_shaft_accel_calculated * *(int *)&_cx; 

/*** calculate filtered input and output shaft speeds for AutoSplit ***/ 

determine os_based_on_rcs variable ***/ 
if (output speed <"1000)" 
< 

bx = aux speed; /* BIN 0 */ 

"cx » 8IN~10; /* BIN 10 */ 

"ax * L OUTRANGE; /* BIN 10 */ 

asm mulu "cxdx, _bx; /* make aux_speed BIN 10 */ 

asm divu "cxdx, ^ax; /* divide by low range BIN 10 */ 

os based on res * cx; /* BIN 0 */ 

> 

/** input speed filtered a (input speed filtered * IS FK1) ♦ 
(input_speed * (1-IS_FK1) **/ 

ax = (is filtered bin8 » 4) ; 
"cx a IS_FK1 ; 
asm mulu _axbx, _cx ; 
asm shrl _axbx, j¥4 ; 
is_f i ltered_partial_1 = _axbx ; 

cx = input speed ; 
^ax = 256 -~IS_FK1 ; 
asm mulu _axbx, _cx ; 
is_fi Itered _partial_2 = _axbx ; 

is_filtered_bin8 » is_f i ltered_partial_1 ♦ is_f i ltered_partial_2 ; 

input_speed_f iltered = (unsigned int)( is_f i ltered_bin8 » 8); /* BIN 0 */ 

/** output speed filtered = (output speed filtered * OS FK1 ) ♦ 
" (output_speed * (T-0S_FK1) *V 

_ax = (os filtered bin8 » 4) ; /* BIN 4 */ 

_cx = OSJK1 ; " /* BIN 8 V 

asm mulu" axbx, cx ; /* BIN 12 */ 

asm shrl "axbx, #4 ; /* BIN 8 V 

os_fitteredj>artialJ = _axbx ; /* BIN 8 */ 

if (output_speed < 250) 

_cx » os"based_on_rcs; /* BIN 0 V 

else 

_cx « output_speed ; /* BIN 0 */ 

_ax * 256 - QS_FK1 ; /* 1 BIN 8 - OS_FK1 V 

asm mulu exbx7 cx ; /* BIN 8 V 

os_fi Itered j»rtTal_2 » _axbx ; /* BIN 8 V 

os_filtered_bin8 » o»^ff Iter ed_partia l_1 ♦ 03_f i lteredj>artial_2 ; 

output_speed_fi Itered » (unsigned int)(os_f iltered_bin8 » 8); /* BIN 0 V 

/** input_speedjiccel_fUtered » (input_speed_accel J\ Itered * DISFK1) ♦ (input.shaft.accel * (1-DISFK1) **/ 

cxdx = *(ulong *)&dis filtered bin8; /* BIN 8 V 

asm shral cxdx, #4; " " /* BIN 4 ( cx) V 

asm mul cxdx, #DISFK1; /* BIN 12 */ 

asm shraT _cxdx, #4; /* BIN 8 V 

dis_f iltered_bin8 « *(long *)&_cxdx; 7* save partial result V 

_cx ■ *(uint *)&input speed accel; /* BIN 0 */ 

Jw « 256 - DISFK1; " " /* 1 BIN 8 - 0ISFK1 */ 

asm mul jrxdx, Jxx; /* BIN 8 */ 

di9_filteredj>in8 *(long *)&_cxdx; /* sum is final result */ 

input_speed_accel_f i Itered * (int)<dis_f i ltered_bin8 » 8); /* BIN 0 */ 



/** determine state of clutch **/ 

if (engine_speed > input_speed) 

clutch_sTip_speed ■ englne.speed - input_speed; 
else 

clutch_sl ip_speed = input^speed - engine_speed; 

if (clutch slip speed > 200) 
clutch_state~= DISENGAGED; 
else 

if ( (engine jspeed > 800) && (low_speed_latch == FALSE)) 
clutch_state = ENGAGED; 

/** determine desired percent torque needed for zero torque at flywheel **/ 

#if (0) ; 
if ((accelerator _pedal _posi tion < 2) && 
(clutch_state ENGAGED) && 

(current_gear «« 0) U ^ ^ 

(input speed filtered < 1100) && v - 

(((engTne_control « OVERR I DE_D I SAB LED ) U y c 

(low_speed_latch == FALSE) &ft (current_gear == 0)) || 
( output_speed_f i Itered < 20))) 
percent torque accessories = engjxrcent torque filtered; /* get at idle */ 
#endif 

percent_torque_accessories = 3; /* force value for now */ y - [ c 

needed _per cent _for_zero_f lywheei_trq = percent_torque_accessories + ( +c/ & 

nominal_friction_pct_trq; \ fx/-** i,, 

V- 

overall_error = ((signed int)( input_speed_fi Itered) - (signed intMgos)); y- 



> 

#pragma EJECT 



- V 1 



* Function: coraaunicate_wf th_dri veline 
* 

* Description: 

* This is the periodic task which controls the actions of the engine 

* by defining (node of control and controlling speed and torque output 

* levels depending upon the control function being performed. This task 

* is also intended for control of other driveline components (not yet 

* named) which may be available in the future. 

void communicate with drivel ine<void) 
< 

initial! ze_dr i ve I i ne_da t a( ) ; 

x startjseriodic( ); 

while (1) 

C 

cont ro l_eng i ne_compress i on_brake< ) ; 

determine_gos(); /* calculate <G)ear times the (Output (S)haft */ 

determine_shiftabi I ity_variables(); 

if (engine communication active) 
( 

if ((desired_sync_test_mode == TRUE) && (output_speed_f i Itered < 100)) 
cont ro I _eng i ne_sync_t es t jnode( ) ; 

else 

< /* start of normal engine_commands switch */ 

switch (engine commands) 
{ 

case ENGINEERED IP: 

cont ro I _eng i ne_pred i p( ) ; 
break; 

case ENGINE_SYNC: 

control_engine_sync(); 

breaks- 
case ENGINE_RECOVERY: 

cont r o I _eng i ne_recovery( ) ; 

break; 

case ENGINEJDLE: 

cont ro l_eng i ne_id I e( ) ; 
break; 

case EWGINE_START: 

control_engine_start(); 
break; 

case EHG ! NE_F0L LOVER : 
default: 

control_engine_fol lower( ); 

break; 

> 

> /* end of normal engfne.comnands switch */ 

switch (eng brake command) 
( 

case ENG_SRAKE_OFF: 

retarder_control = TQROUE_CONTROL; 
desired_retarder_pct_trq « 0; 
break; 

case ENG_BRAJCE FULL: 

retarder_control = TOR0UE_CQNTROL; 
desired_retarder _pct_trq * -100; 
break; 

case ENG_BRAKE_IDLE: 
default:" 

retarder_control * 0VERRIDE_DISABLED; 



> 



desired retarderjact_ti-q ■ 0; 
break; " 

> 

> 

else 

engine.status » EWIMEJK)TJ>RESEMT; 

/* store old value for use in "con trol_engine_fol lower" function */ 
accelerator .pedal j»sition_old ■ accelerator_p«kl_position; 

x syncj^er iodic (US PER LOOP); 

> 

x_end joeriodicO; 



* Unpublished and confidential. Not to be reproduced, 

* disseminated, transferred or used without the prior 

* written consent of Eaton Corporation. 
* 

* Copyright Eaton Corporation, 1994 

* All rights reserved. 



* Filename: prj*Jj*.c96 (AutoSplit) 
* 

* Description: 

* The modules contained within this compilation unit are 

* intended to implement functionality of the Process System 

* Input Signals task defined in the design document ion. 

* In general, Analog to digital conversions are started on 

* PortO. The necessary hardware initialization and variable 

* initializtion for inputs on PortO are handled. The switch 

* inputs are captured to avoid conflict with AD conversions 

* and all necessary scaling and error check for these inputs 

* is conducted. 
* 

* Part Number: <none> 
* 

* SLog: ? 
* 

* Rev 1.1 19 May 1994 11:32:26 markyvech 

* Converted for use with AutoSplit ECU2 
* 

* Rev 1.0 12 Sep 1991 08:04:26 amsallen 

* Initial revision. 



* 

* Header files included. 
* 



# include <exec.h> /* executive information */ 

^include <kr sfr.h> /* ICR special function registers V 

#include <kr~def.h> /* ICR definitions */ 

#include <c regs.h> /* ICR internal register definitions */ 

#include <wwslib.h> /* world wide software definitions V 

#include "pr s i s.h" /* process system input signal information */ 

tfinclude "sysgenTh" /* defines the task names and priority */ 



* ^defines local to this file. 



/* Start_AD_Conversions */ 

#define ENABLE AO PTS SCAN 0X20 
#define ENABLE JU> J SR 0X20 

#define PERIOD 10U /* 10ms V 

#define RICH PERIOD SOU /* 50ms V 



* Constants and variables declared by this file. 
* 

**************#****.****************************************************/ 

/* Analog Inputs on PortO */ 

int ignition_volts; 
int splitter_position; 



#define IGN I T ION_VOLTS_CHANNEL_RESULT 1 



15 

/* 
/* 
/* 

/ 



for state tine » 125 nsec: /*/ 
sarcple time * 3.6250 usee V 
convert time * 20.1875 usee */ 
scan and convert 8 channels */ 



#define SPL I TTER_PQS_CHANNEL_RESULT 
#define CONVERSION^ IKE Oxef 

^define C0NVERT_8 8 

^define CONVERT IGNITIQNJ/OLTS 
#define UNUSED CHANNEL J 
#define UNUSED CHANNEL 2 
#define UNUSED~CHANNEL_3 
#define UNUSED CHANNEL_4 
#define UNUSED CHANNEL_5 
#define UNUSED'CHANNEL 6 
#define CONVERT SPLITTER_POS 
#define STOP CONVERSION 
#define START_CON VERS IONS 

/* table containing AD_result and AD.Cotrmand values after PTS scan */ 
unsigned int AD_TableM6] ; 

/* AD SCAN PTS CONTROL BLOCK LOCATION V 

ad_ptsb type AD_Con_Bloclc; 

Ipragma Tocate(AD Con Block=0x01F8) /* locate pts control block */ 

#pragma ptsCADJTon^Block = 5) /* set pts vector 5, A/D done */ 



(_N0RM MODE 

( norm~mooe 
("norm'mooe 
("norm'mooe 

<~N0RM~MO0E 

c"norm"mooe 
(~norm~mooe 
( norm'mooe 

0x00 
ad command 



10 BIT MODE 

"io"bit~mooe 
'io"bit mooe 
"io'bit mooe 
"io'bit mooe 
"io~bit~mooe 
"10 bit mooe 
"io~bit~mooe 



strt 
"strt* 
"strt 
"strt 
"strt 
"strt 
"strt 
"strt 



conv 

CONV 
CONV 
CONV 
CONV 
CONV 
"CONV 

"conv 



CHNL 0) 
"CHNL~1 ) 
"CHNL~2) 

"chnl"3) 

CHNL 4) 
"CHNL_5) 
"CHNL~6) 
"CHNL"7) 



= CONVERT IGNITION_VOLTS 



#pragma eject 



* 

* Function: InitializeJnput_Signals 
* 

* Description: 

* This routine initializes the A/0 converter. It sets the A/D to 

* run in PTS scan wode, lObit conversion. The PTS control block is 

* set up and the Command/result table is initialized. 
* 



void InitializeJnput_Signals(void) 

C /* if we knew when the first speed packet arrived, we could initialize 
with those values, since we don't, be safe and use zero. */ 



AD Table CO] 

AD~Table[1] 

AD~Tablet2] 

AD~Table(33 

AD~Table[4] 

AD~Table[5] 

AD~TableC6J 

AD~Table[7] 

AD~Table[8] 

AD~Tablet°] 

AD~Table[10] 

AD~Table[11] 

AD~Table[12] 

AD"TableC133 

AD~Table[H] 

AD"Table[15] 



= UNUSED CHANNEL 1; 
= OxOOOOj 

= UNUSED CHANNEL 2; 
= OxOOOOj 

= UNUSED CHANNEL 3; 
= OxOOOOj 

= UNUSED_CHANNEL_4; 
s 0x00007 

= UNUSED_CHANNEL_5; 
= OxOOOOj 

= UNUSED_CHANNEL_6; 
= 0x0000; 

= CONVERT_SPLITTER_POS; 
= 0x0000;" 
= STOP_CONVERSION; 
s 0x0000; 



AD Con Block.cnt = C0NVERT_8; 
AD~Con~Block.ctrl = _AD_HOOE | _S_D_UPDT ; 



AD Con Block. s d = AD Table; 
AD'Con^Block.reg = (void *)&_ad_result; 

ad time = CONVERSION JTIME; 
~ad"test = NO OFFS; 
3pts_select &= ~ (_PTS_ADDONE_B IT); 



/* place holder for channel 1 

/* I GN I T I QN_VOLTS_CHANNEL_RESULT 

/* place holder for channel 2 

/* UNUSEDJ.RESULT 

/* place holder for channel 3 

/* UNUSED _2_RESULT 

/* place holder for channel 4 

/* UNUSED_3_RESULT 

/* place holder for channel 5 

/* UNUSED_4JESULT 

/* place holder for channel 6 

/* UNUSED_5_RE$ULT 

/* Command convert splitter pos 

/* UNUSED_6_RESULT 

/* command to Stop conversions 

/* SPLITTER POS_CHANNEL_RESULT 



*/ 
*/ 
V 
*/ 
V 
V 
*/ 
V 
*/ 
V 
*/ 
*/ 
V 
*/ 
*/ 
*/ 



/* A/D mode bits 0,1 of PTSJTONTROL 
/* always set to 3h bit 2 = 0 
/* S/D update at end of cycle 
/* bit 5 always 0 
/* Set mode for AD SCAN 

/* Load s_d with AD_Table address 
/* Load reg with ADJtesult address 



/* Disable test 
/* Disable AD PTS */ 



> 



#pragma eject 



* Function: AOJSR 

* "* 

* Description: 

* This interupt service routine resets the PTSCOUNT, pts_sd and pts_reg 

* for another PTS_Scan A/0 cycle. It also readies a task to run when 

* a PTS cycle has'cccnpleted. 
# 

^pragma interrupt(ADJSR=5> 

void AO ISR(void) 

C 

x start isr(); 

AO Con Ilock.cnt = CONVERT 8; /* Reset pts count for next cycle */ 

AD~Con~Block.s_d = AD_Table; /* Reset table pointer to start of table 

AD~Con~Block.reg = (void *>&_ad_resutt; 

x_reaoV<PROCESSJNPUT_$IGNALS>; /* Ready pr_s_i_s task V 

x end isr<); 

> 



#pragma eject 



* Faction: Start_ADj:onversions 
* 

* Description: 

* This function initializes the input signal processing function 

* if it has not already been done, and then startes the PTS Scan 

* of the AO channels by sending the appropriate command to the 

* ad_command register. 

*************************************************•**********************/ 

void Start_AD_Convers ions (void) 
( 

if (( int mask & ENABLE AD ISR) == 0 ) 

!n7tiaTizeJnput_Signals(); /* Set up AD table for PTS * 

_pts select |= ENABLE AD PTS SCAN; 
Jntjnask |= ENABLE_ADJSR; 

x_prearm_stimulus(); 

START_CONVERSIONS; /* Start a conversion, initiate the PTS cycles V 
x_wait_stimutus<); /* *D_ISR will ready task when PTS is complete */ 



#pragma eject 



# 

* Function: process_input_signaU 
* 

* Description: . 

* This is the periodic task which starts the analog conversions on PortO. 
* 

void process input_signals(void) 

x_start_periodic<); 

white (1) 

< 

Star t_AD_Conve rs i ons ( ) ; 

/* Clean up and scale AD values V 

ignition volts = scale_system_ad_inputs(IGNITION - VOLTAGE); 
splitterjwsition = sea I e_sys t em_ad_i nput s( SPL I TTER_POS I T I ON ) ; 

/* x syncj>eriodic<PERI00*1000); V 
x sync_periodic(RICM_PERI00*1000>; 

> 

x endjseriodicO; 

> 



#pragma eject 



* Function: seal e_s ys t e»_ad_ i npu t s 
* 

* Description: ^ . 

* This function removes the channel, status and reserved bits from 

* the raw AO values, and performs alt necessary scaling and error 

* checking for the analog inputs on PortO. 



int scale_system_adjnputs(char Channel) 

int Scaled Value = 0; 

uint volts^per bit; /* BIN 16 V 

uint units_per bit; /* BIM 16 */ 

#define TUELVE~VOLT FULL SCALE 22.46 /* volts */ 

#define TWENTY~FOUR~VOLT~FULL_SCALE 40.49 /* volts V 

^define D I STANCE_FULL_SCALE 100 /* */ 

volts per bit =* <uint)((TUELVE VOLT_FULL_SCALE*65536/1023)+0.5); 
units_per"bit = (uint)<(DISTANCE_FULL_SCALE*65536/1023)+0.5); 

switch (Channel) 
C 

case 0: /* IGNITION VOLTAGE */ 

cx = AD TableUGNITION VOLTS CHANNEL RESULT] » 6; 
asm mulu" cxdx, vol tsjDeYj>i t; /* volts, BIN 16 <_dx, BIN 0) V 
Scaled J/aTue = *<int *)&_dx; 
break; 

case 1: /* UNUSED V /* to be completed when a product requires it */ 
Scaled_Value = (0); 
break; 

case 2: /* UNUSED */ /* to be completed when a product requires it */ 
ScaledJ/alue = (0); 
break; 

case 3: /* UNUSED V /* to be completed when a product requires it V 
ScaledJ/alue = (0); 
break; 

case 4: /* UNUSED */ /* to be completed when a prockjet requires it V 
ScaledJ/alue = (0); 
break; 

case 5: /* UNUSED */ /* to be completed when a product requires it */ 
ScaledJ/alue = (0); 
break; 

case 6: /* UNUSED */ /* to be completed when a product requires it */ 
ScaledJ/alue = (0); 
break; 

case 7: /* SPLITTER POSITION */ 

cx = AD TableCSPLITTER_POS CHANNEL JtESULT] » 6; 
a"sm mulu" cxdx. unitsj>erj>it; /* distance, BIN 16 (_dx, BIN 0) */ 
ScaledJ/alue = *(int *)&_dx; 
break; 

default: 
break ; 

> 

return <Scaled_Value); 



y A*********************** ********** 



a*************************** 



Unpublished and confidential. Not to be reproduced, 
disseminated, transferred or used without the prior 
written consent of Eaton Corporation. 

Copyright Eaton Corporation, 1993-94. 
All rights reserved. 



* Filename: set.gcar.c96 (AutoSpUt) 
* 

* Description: 

* This module is the periodic task "select^gear". It assigns values 

* to destination gear_selected as a function of selectedjnode, input 

* and output shaft speeds, and driver selections (dccjnanuaMnput). 

* Shift parameters are in the data structure shf_tbl. Before setting 

* destination_gear_selected, gears are checked with available_gear(). 
* 

* Part Number: <none> 
* 

* Slog: R:\ashift\vcs\sel_gear.c9v % 
* 

* Rev 1.8 21 Feb 1994 15:07:14 schroeder 

* Replaced shiftabi lityjnode with new flag, engine_brake_avai lable. 
* 

* Rev 1.0 29 Jul 1993 16:40:26 schroeder 

* Initial revision. 



I ********************************** 
* 

* Header files included. 



************************************** 



# include <exec.h> 
#include <c_regs.h> 
#include <wwslib.h> 
#include "cont_sys.h" 
#include »conjT939.h" 
#include M drl_cmds.h» 
#include "sel_gear .h" 
#include "shf~tbl.h" 
#include "trn tbl.h" 
#include «calc_spd.h M 
#include »trns_act.h M 
#pragma noreentrant 



/* executive information */ 
/* c registers */ 

/* contains common global defines V 
/* control system */ 

/* defines interface to j1939 control module 

/* drive line commands information */ 

/* select gear */ 

/* shift table definition */ 

/* (system) transmission table definition V 



* #defines local to this file. 



#define USJ>ERJ.OOP 40000U 
#def ine INITIAL START GEAR 1 



* Constants and variables declared by this file. 



/* public */ 
char dest i nat i on_gear_se I ec ted; 



cnar uebi 1 1 us i iui i — ywi «w i 

char dest i nat ion_gear; 

char f I ashjdes i r ed_a 1 1 owed; 

char desired_gear; 



char desired_gear; 

char desired_gear_dn; 

char desired_gear_up; 

uchar coast ing_latch; 

uchar sel_gear_cntr1; 

uchar sel~gear_cntr2; 

uchar sel_gear_cntr3; 



/* debug use - delete later */ 
* debug use - delete later */ 



/ 

/* 



debug use 
debug use 



delete later */ 

delete later */ 

_i _ i _ ~ _ i _ * / 



/* debug use - aeiete later 
/* debug use - delete later 



uchar shif t_init_type; 

uint Ipf output speed; 

int dosj>redicted; /* BIN 0 */ 

int dosj>rdtd_linno_jalce; /* BIN 0 */ 



/* local */ 

/* filter weights for the "rnda" output speed filter */ 
static register uchar w1; 
static register uchar w2; 
static register uchar w3; 
static register uchar w4; 

/* shift table (define and extern in shf_tbl.h) */ 
struct shf_tbl_t shf_tbl; 

/* default shift table values */ 
const struct shf_tbl_t ini_shf_tbl = 
t 

1200, /* aut_dwn_rpm */ 

1000, /* autjni n_dwn_rpm */ 

1700, /* autjop^rpm */ 

0, /* best_gr_offset */ 

50, /* dwn_of fset_rpm */ 

100, /* dwn_reset_rpm */ 

400, /* dwn"timer~offset_rpm */ 

40, /* hysteresi sj-pra */ 

1850, /* man_dwn_s ync_ r pro */ 

700, /* man~up_sync_rpm V 

1900, /* rated_rpm */ 

150, /* up_of fset_rpm */ 

12s] /* up~reset_rpm */ 

200, /* up~timer_offset_rpm */ 

0, /* dwn_acceT */ 

8, /* up_accel */ 

3000, /* offset_time */ 

(uintXO. 25*256), /* aut_upjxt */ 

10, /* min_output_spd */ 

1 ( /* max~start_gear */ 

q', /* padbytel */ 

196, /* kl ability, mi n- ft /rev- sec, 81M 12 V 

431, /* axle rational, BIM 7 */ 

383, /* gcw k1, rev/sec-min-ft, BIN 0 */ 

2437, /* gcw'k2, rev/sec*2, 8IN 7 */ 

1325, /* calc_start _point, rpm, BIN 0 */ 

107, /* k6_ability, min-lb-ft-sec/rev, BIN 8 * 

1500, /* auto_up_lo_base, rpm, BIN 0 */ 



1100, /* auto~dn"lo_base, rpm, BIN 0 V 

100, /* auto~rtd_offset, rpm, BIN 0 */ 

1000, /* lowest_engage_rpm, BIN 0 */ 

0, /* padwordl */ 

0 /* padword2 V 



>; 



/* local — initialized at start of task by select_gear V 

/* shift points with anti-hunt offsets; referenced by auto^downshift and 

auto_upshift; set by get_automatic_gear and select_gear */ 
uint upshift j»int; 
uint downshift _point; 

/* lower limit for gear selections V 
char lowest_forward; 

/* indicate direction of a get_automatic_gear shift; referenced by 

get manual_gear; cleared by~select_gear when shift complete */ 
char automat ic^sip; 

/* used in the determination of shiftjjoints based on throttle position 
static uint auto_up_rpm; 
static uint auto_dn_rpm; 
static uint auto_up_of f set_rpm; 
static uint auto_dn_of f set_rpm; 

/* delay counter for ant i -hunt V 
static uchar antihunt_counter; 



/* gross combined weight calculations */ 

#define ZERO SPEED TIMEJ.INIT 4500 /* 3 «in 3 0.040 period V 

#def ine VALID OLD DATA TINE 100 /* 4 sec a 0.040 period V 

#define MAX VEHICLE WEIGHT 100000 /* 100,000 lbs */ 

JWefine DOS~OFFSET TnIT 48 

#define ENG~DECEL LOW LIMIT -350 /* rpm/s */ 

#define ENG~DECEL~LPF~ 224 /* exp(-2pi(0.53Hz)(0.040s)) = 0.875 (BIN 8) */ 
#pragma eject 



* Function: mda_output_f i Iter 



* Description: 

* This is a one pole LPF with a variable coefficient. The magnitude 

* of the coefficient is directly related to the acceleration content 

* of the speed sample and the frequency. 
* 

static void mda output_f i Iter(void) 
t 

tfdefine K1 8 
tfdefine K2 24 
#define K3 48 
#def ine K4 160 

static register uint os_delta_speed; 
static register uchar weight; 

if (Ipf output speed > output_speed) 

os_delta_speed = lpf_output_speed - output_speed; 
else 

os_delta_speed = outputs peed - lpf_output_speed; 

if <os delta speed <= K1) /* delta <=* 200 rpm/s */ 

( 

if <w1 > 1) -w1; 
if (w2 < 5) +*w2; 
if (w3 < 6) ++w3; 
if (u4 < 7) ++w4; 
weight = w1; 

else if (os delta speed <= K2) /* 200 rpm/s < delta <= 600 rpm/s */ 
i 

if (wl < 4) +>w1; 
if (w2 > 2) --w2; 
if (w3 < 6) ++w3; 
if (w4 < 7) ++w4; 
weight = w2; 

else if (os_delta speed <= K3) /* 600 rpm/s < delta <= 1200 rpm/s */ 

i 

if (wl <*4) +*w1; 
if (w2 < 5) ++w2; 
if (w3 > 3) --w3; 
if (w4 < 7) ++W4; 
weight = w3; 

else if (os delta speed <= K4) /* 1200 rpm/s < delta <= 4000 rpm/s */ 

if (wl < 4) ++w1; 
if (w2 < 5) ++W2; 
if (w3 < 6) ++w3; 
if (w4 > 3) --w4; 
weight = w4; 

else /* ^0°° rDm / s K telta */ 

if <w1 < 4) 
if <w2 < 5) **w2; 
if (w3 < 6) >*w3; 
if (w4 < 7) **w4; 
weight = 7; 

> 

Ipf output speed = lpf_output_speed ♦ 

(output"speed » weight) - <lpf_output_speed » weight); 

> 

#pragma eject 



* Function: ne*_input_speed 
* 

* Description: 

* A utility function that returns the input shaft speed expected if 

* "gear" was engaged with the present output shaft speed. 



static uint new input_speed(char gear) 
< 

/* new input speed = Ipf output_speed * gear_ratio */ 
ax = trn tbUgear ratioTgear + GR_OFS] ; /* 8IM 8 V 

asm mulu "axbx, Ipf output speed; /* BIM 0+8=8 (_axbx) V 

asm shrl "axbx, #8;" ~ /* BIN 8»=0 (_ax) */ 

return ax; 

> 



#pragma eject 



* Function: auto_upshift 
* 

* Description: 

* This boolean function returns true when automatic upshift 

* conditions have been met. 
* 

static int auto upshif t(void) 
C 

/* if (input speed > upshif tjx> int) */ 

if (<gos > upshiftj»int) && <output_speed_f i Itered > 120)) 
i 

if (engine_communication_active) 

/* if <<!shiftabilityju>td) && <!shiftability_holdJI)) V 
se I _gear_cn t r2++ ; 
return 1; 

> 

> 

return 0; 



#pragma eject 



* Function: auto_do«nshif t 

* "~ 

* Description: 

* This boolean function returns true when automatic downshift 

* conditions have been met. 
* 

static int auto downshift(void) 
t 

/* if (input_speed < downshift _point) */ 
if <gos < downshift_point) 
( 

return 1; 

> 

return 0; 

> 

#pragma eject 



* Function: detennine_autospl it_type 
* 

* Description: 

* This function is used to determine if the impending shift type is 

* MANUAL or AUTO. 



static char determine autospli t_type(char passed_new_gear, char passed_initial_gear) 
( 

register char new_gr = passed_new_gear; t 
register char init_gr = passed_ini tial_gear; 

if <<shift_in_process == FALSE) || (engine_status == ENGINE_RECOVERY_MOOE)> 



if ((new_gr == 

(new_gr == 

(new_gr == 

(new_gr == 

<new_gr == 

(new_gr == 

(new_gr == 

(new_gr == 

(new_gr == 

(new_gr == 



1 && init_gr «■ 2) 

3 && init^gr » 4) 

5 && init~gr « 6) 

7 && init~gr sa 8) 
9 && init~gr == 10) 

10 && init~gr == 9) 

8 && init~gr == 7) 

6 && init_gr == 5) 

4 && init_gr == 3) 

2 && init~gr == 1)) 



shift_init_type = AUTO; 
else 

shift_init_type = MANUAL; 



/* 
/* 
/* 
/* 
/* 
/* 
/* 
/• 
/* 
/* 



dn 
dn 
dn 
dn 
dn 
up 
up 
up 
up 
up 



*/ 
*/ 

V 
*/ 
V 
V 
V 
*/ 
V 
V 



if (Cinit gr <= 4) && (new_gr < init_gr)) 

shift_Tnit_type = MANUAL; /* prevent coasting auto downshifts in Low gears */ 



^pragma eject 



* 

* Function: get_automatic_gear 

* ~" 

* Description: 

* This function returns an "automatic" forward gear selection. It 

* also performs driver requested shifts (manual_request) restricted , 

* by shaft speeds. If no gears are available in required direction, 

* initial_gear is returned. 

* " 

static char get automat ic_gear( char ini tial_gear, char manual_request) 
register char new_gear = ini tial_gear; 
if (automatic sip != -1) 
se I _gea r_cnt r3++ ; 

/* initiate or continue an automatic upshift: search up from lowest_forward 
(fastest input speed) for the first available gear that will provide input 
speed below a value (approx upshift rpm, minus an offset for gears that will 
result in a net downshift) */ 

for (new gear = lowest_forward; 

(newjnput_speed(new_gear) > (upshift_point - 
(new gear < initial gear ? 

(shf tbl.up_offset_rpm ♦ auto_dn_of fset_rpm) : shf_tbl .best_gr_of fset))) 
&& (new_gear <= trn_tbl .highest - forward); 
++new_gea^) 

/* if we ran out of gears and the highest is available, it must be due to speed; 

pick highest_forward, input speed will be slower than it is now V 
if (new_gear > trn_tbl ,highest_forward) 

new_gear = trn_tbl .highest_forward; 

desired_gear = new_gear; 
desired~gear_up = new_gear; 

determine_autosplit_type(new_gear, ini tial_gear); 

/* if in gear manual or the selection will underspeed, pick initial_gear */ 
if (((shift init type == MANUAL) && ( transmissionjxsi tion == INJSEAR)) || 
(( automat ic_sip == 0) && (new_gear <= initial_gear))) 
new_gear = ini tial_gear; 
else 

/* indicate gear change and adjust downshif tjpoint */ 
automat ic_sip = +1; 
auto_up_of fset_rpm = 0; 
if (shift init'type == AUTO) 
auto_dnj>ffset_rpm = shf_tbl .dwn_timerj)f fset_rpm; 

else 

auto dn_offset_rpm = 0; 

) 

> 



if (( automat ic_sip 1) && (initial_gear > I owes t_f or ward)) 

/* initiate or continue an automatic downshift: search down from 

highest forward (slowest input speed) for the first available gear that will 
provide~input speed above a value (approx downshift rpm, plus an offset for 
gears that will result in a net upshift) V 

for (new_gear = trn_tbl ,highest_forward; 

(new 7nput_speed(new gear) < (downshif t_point + 

(new_gear > initial_gear ? shf_tbl ,dwnj>f fset_rpro : shf _t bl .best_gr_of fset))) 
&& (new^gear >= lowest~forward); 
--new_gear) 

/* if we ran out of gears and the lowest is. avai I able, it must be oVie to speed; 

pick lowest_forward, input speed will be faster than it is now V 
if (new_gear <~lowest_forward) 

new_gear = lowest_forward; 

desired_gear_dn = new_gear; 

if (desired_gear_dn < ini tial_gear) /* must be a down shift or else it */ 



desired_gear = new_gear; 



/* wrongly cancel the desired_up pick. 



deten»ine_autosplit_tYpe(ne«_gear, initial_gear); 

/* if in gear manual or the selection will overspeed, pick initial_gear */ 
if (<<shift_init_type == MANUAL ) && < transmissionj»si t ion == 1N_GEAR) ) || 
<(automatic_sip == 0) && (new_gear >= ini tial.gear))) 
new_gear * initial_gear; 
else 

/* indicate automatic gear change and adjust upshift_point */ 

automat ic_sip 3 -1; 

auto dn offset_rpm = 0; 

if (shift init_type == AUTO) 

auto_up~offset_rpm = shf_tbl .up_timer_of fset_rpm; 
else 

auto up offset_rpra » 0; 

> 

> 

return new_gear; 

) 

#if (0) 

**** This is the select gear based on AutoShift code **** 



#pragma eject 



* Function: get_automatic_gear 
* 

* Description: 

* This function returns an "automatic" forward gear selection. It 

* also perforins driver requested shifts (manual_request) restricted 

* by shaft speeds. If no gears are available in required direction, 

* initiat_gear is returned. 

* ~" 

*****************************♦******************************************/ 

static char get automatic_gear(char initial_gear, char manual_reqyest) 
register char new_gear = ini tial_gear; 

if (((automatic sip == 0) && auto_upshift()) || ( automat ic_sip > 0)) 
C 

sel_gear_cntr3++; 

/* initiate or continue an automatic upshift: search up from lowest_forward 

(fastest input speed) for the first available gear that will provide input 

speed below a value (approx upshift rpm, minus an offset for gears that will 

result in a net downshift) */ 
for (new_gear » lowest_forward; 

<new_Tnput_speed(new_gear) > (upshift _point - 
(new gear < initial_gear ? 

(shf_tbl.up_offset_rpm ♦ auto_dn_of fset_rpm) : shf_tbl .best_gr_of fset))) 

&& (new_gear <= trn_tbl ,highest_forward); 

♦+new_gear) 

# 

/* if we ran out of gears and the highest is available, it must be due to speed; 

pick highest_forward, input speed will be slower than it is now */ 
if (new_gear > trn_tbl ,highest_forward) 

new_gear = trn_tbl ,highest_7orward; 

desired_gear « new_gear; 

determine_autospli t_type(new_gear, ini tial_gear); 

/* if in gear manual or the selection will underspeed, pick initial_gear V 
if ((shift_init_type == MANUAL ) && (transmissionj»si tion == I N_GEAR ) ) 

new_gear * ini t ial_gear; 
else 
C 

/* indicate gear change and adjust downshif t_point */ 

automat ic_sip = 

auto_upj>ffset_rpm = 0; 

if (shift init'type == AUTO) 

auto_dn~offset_rpm = shf_tbl ,dwn_timer_of fset_rpra; 
else 

auto dn offset_rpm = 0; 

> 

> 

else if (((automatic sip == 0) && 
(auto_downshift()) && 
(initial_gear > lowest_forward)) || 
( automat ic_sip < 0)) 

/* initiate or continue an automatic downshift: search down from 

highest forward (slowest input speed) for the first available gear that will 
provide"input speed above a value (approx downshift rpm, plus an offset for 
gears that will result in a net upshift) V 

for (new_gear = trn_tbl .highest_forward; 

(new Input speedTnew gear) < (downshif t_point ♦ 

(new gear > initial_gear ? shf_tbl ,dwn_of fset_rpro : shf_tbl ,best_gr_of fset))) 
&& (new~gear >= lowest_forward); 
*-new_gear) 

/* if we ran out of gears and the lowest is available, it must be ofcje to speed; 

pick lowest_forward, input speed will be faster than it is now V 
if (new_gear < lowest_forward) 

new_gear = I owes t_f or ward; 

desired_gear = new_gear; 

determi ne_autospl i t_type(new_gear , i ni t i a l_gear ) ; 



/* if in gear manual or the selection will overspeed, pick initial_gear */ 



if <<shiftjnit_type = MAMUAL) && <trans«issionj»sition » I N_GEAR ) ) 

new_gear~» in7tial_gear; 
else 

/* indicate automatic gear change and adjust upshift _point */ 

automat ic_sip ■ -1; 

auto dn offset_rpra = 0; 

if <shiftjnit_type = AUTO) 

auto_up~offset_rpm = shf_tbl .up_timer_of fset_rpm; 
else 

auto up offset_rpra = 0; 

> 

> 

return new gear; 

> 

#endif 

#pragma eject 



* Function: deterraine_desti nation 

* Description: 

* This function uses "coast ing_latch" to determine if a coasting or 

* skip shift is being attempted. When sensed, the latch is used in 

* the determine_base_pts function to effect the base shift points. 



void determine destination(void) 

/* if coasting in neutral - force shift points V 



if (coast ing_latch == FALSE) 

if ((last known_gear - destination_gear_selected) > 1) /* multi downshift 
< 

if ((destination_gea reelected == 7) 
(destination_gear_selected « 5) 
(destination_gear_selected ==3) 
( des tination~gea reelected == 1)) 

< 

des t i na t i on_g ea r_se I ec t ed++ ; 
coasting latch = TRUE; 

> 

> 

else 

if ((destination_gear_selected - lastJcnown_gear) > 1) /* multi upshift 
< 

if ((destination_gear_selected == 10) 
(destination_gear_selected == 8) 
( des tination_gea reelected == 6) 
(destination gear selected == 4)) 

< 

dest i nat i on_gear_se I ec ted- - ; 
coasting latch = TRUE; 

> 

> 

> 

> 

else 

if (shift_in_process == FALSE) 
coast ing_latch = FALSE ; 



#pragma eject 



* 

* Function: determine_manual_shi f t_pts 
* 

* Description: 
* 

static void detenninejnanual_shif t_pts(void) 
( 

if (coasting latch == FALSE) 
< 

if (( last _known_g ear == 1) 
( last_known_gear == 3) 
( last Jcnown_gear ==5) 
(last_known_gear == 7) 
( last _known_g ear ==9)) 
auto_dn_rpro =~1325; /* manual downshifts V 

else 

auto up rpra = 1375; /* manual upshifts */ 

> 



> 

#pragma eject 



****** ** *** ** ***** * ******* 

* Function: deterwine_base_auto_shf ft_pts 

* ~~ 

* Description: 

* This function determines the base up and down shift points based on 

* the position of the throttle. These base points will be used in the 

* calculation of the upshift _point and the downshift _point. 
* 

* The ant i -hunting calculations have been moved to this function since 

* these calculations are now throttle dependent. 
* 

************************************************************************/ 



static void determine base auto_shift_pts(void) 
C 

if (pet demand at cur sp > 0) 

/* auto up rpro = shf tbl .auto_up_lo_base ♦ 

(7shf_tbl .aut_up_rpro - shf_tbf.auto_up_lo_base) * Xthrottle) */ 

_cx = shf_tbl.aut_up_rpm - shf_tbt .auto_up_lo_base; 
~bx = pct~demand_at_cur_sp; 
asm mulu "cxdx, _bx; 
asm divu "cxdx, #100; 

auto_up_rpm = sh f_tbl - aut o_up_ I o_base ♦ _cx; 

/* check for RTD requirement V 
if (pct_demand_at_cur_sp > 90) 

auto~up_rpnf+=~shf_tbl ,auto_rtd_of fset; 

/* auto dn rpm = shf tbl. auto dn lo base ♦ 

(?shf_tbl.aut_dwn_rpm -~shf_tbl .auto_dn_lo_base) * Xthrottle) V 

_cx = shf_tbl.aut_dwn_rpm - shf_tbl .auto_dn_lo_base; 
~bx = pct~demand_at_cur_sp; 
asm mulu _cxdx, _bx; 
asm divu _cxdx, #100; 

auto dn rpm = shf tbl .auto_dn_lo_base ♦ _cx; 

> 

else 
{ 

auto_up_rpm = shf_tbl .auto_up_lo_base; 
auto~dn~rpm = shf~tbl .auto_dn_lo_base; 



de t e rm i nejnanua I _sh i f t_p t s < ) ; 

if (shift in_process) 
C 

/* reset antihunt_counter */ 
antihunt_counter = 0; 

/* allow the knob display to flashed any new desired gear */ 
flash desired_allowed = TRUE; 

> 

else 
C 

/* reset shift in process flags and update ant i hunt_counter */ 

automat ic_sip * 0; 

if (antihunt counter < 255) 

C 

♦♦antihunt counter; 
/* flash desired allowed « FALSE; V 
> 

/* look for upshift ant i -hunt reset conditions */ 

if ((antihunt counter * (US_PER_LOOP/1000)) >* shf_tbl ,offset_time) 

( 

/* check for last shift = upshift effects */ 

if <auto_dn_of fset_rpm == shf_tbl .dwn_timer_of fset_rpra) 

auto_dn_of fset_rpm = shf_tbl .dwn_of fset_rpm; 
else if~((auto_dn^offse terpen == shf_tbl .dwn_of fsetj-pm) && 

(input_speed_f7ltered~> auto_dn_rpra ♦ shf_tbl .dwn_reset_rpm)) 

auto_dn_of fset_rpm = 0; 

/* check for last shift = downshift effects */ 

if (auto_up_offset_rp» « shf_tbl .up_timer_offset_rpra) 



auto up offset rpm » shf tbl .up.of fset_rp«; 
else if~((auto up'offset rpn » shf.tbt .up_of fset_rp») U 

<irxxitjspeed_fTltered~> auto_up_rp« - shf_tbl.up_reset_rpra)) 
auto_up_offset_rp» » 0; 

/* allow the knob display to flashed the desired gear V 

if (((desired gear > destination_gear_selected) && (gos < (upshift jwint ♦ 25)) 
((desired~gear < destination~gear_selected) && (gos > (downshift^point - 25 
f lash_de$ired_al lowed = FALSE;" 
else 

flash desired_allowed * TRUE; 

> 

> 

/* set the shift points based on throttle and determined offsets V 
upshift_point = auto_up_rca + auto_up_of fset_rpm; 
downshiftjjoint = autoJ5n_rpn - auto_oV»_of fset_rpm; 

/* check that the calculated shift point is reasonable */ 
if (upshift_point > shf_tbl .man_dwn_sync_rpm) 
upshi f t_point = shf_tbl .man_dwn_sync - rpm; 

if (downshiftjx>int < shf_tbl .man_up_sync - rpra) 
downshift_point = shf_tbl .man_up_sync_rpm; 



#pragma eject 



* Function: select_gear 
* 

* Description: 

* This is the root function for the periodic task S£LECT_GEAR. Each 

* loop begins by checking the manual up/down buttons. Then, based on 

* selected jnode and output shaft speed, a *get_. . ..gear 1 function is 

* called to update dest ination_gea reelected. 



void select_gear(void) 

char manual_request; /* current manual request (♦/- 1) */ 

static uchar enable_gcw_calc; /* diagnostic - delete later MV 

enable_gcw_calc * FALSE; /* diagnostic - delete later !!*/ 

shf_tbl = ini_shf_tbl; /* initialize the shift table V 

destination_gear_selected s 1; 
desired_gear = 1; 

/* initialize file scope variables */ 

w1 = 3; 
w2 = 4; 
w3 = 5; 
w4 = 6; 

lpf_output_speed = output_speed; 

upshift_point = shf_tbl .aut_up_rpm; 

downshift_point = shf_tbl ,aut_dwn_rpm; 

auto_up_of fset_rpm = shf_tbl .up_timer_of fset_rpm; 

auto~dn~offset~rpm = shf^tbl ,dwn_t imer_of f set_rpm; 

lowest_forward~= INITIAL~START_GEAR; 

automat ic_sip = 0; 

ant ihunt_counter = 255U; 

coast ing~latch = FALSE; 

f lash_desired_allowed = TRUE; 

x start_periodic(); 
while (1) 

mda_output_filter(); /* update our filtered output speed */ 

manual_request = 0; 
determ7ne_base_auto_sh i f t jsts( ) ; 

/* set destination_gear_selected from function(s) appropriate for selectedjnode */ 

switch (selected mode) 

i 

case REVERSE_M00E: 

case DRIVE MODE: 

if ((forwardjast == TRUE) && ( lowjspeedjatch == FALSE)) 

* destination_gear_selected = get_automatic_gear(destination_gear_selected, manual_request); 
determine destination^); 

sel gear cntrl**; /* debug use only - delete later */ 

> 

break; 

case LOU MODE: 

case HOLD HOOE: 

case NEUTRAL HOOE: 

case PARK MODE: 

case POWER UP HOOE: 

case POWER"dOWM MODE: 

case DIAGNOSTIC TESTJ400E: 

/* prevent transient selection upon mode change (these modes ignore it) */ 

destination_gear_selected =0; 

break; 

default: 

/* invalid mode: do nothing */ 
break; 

> 

x_sync j>eriodic(U$_PERJ.OOP); 



> 

x endjwriodicO; 

> 



Unpublished and confidential. Mot to be reproduced, 
disseminated, transferred or used without the prior 
written consent of Eaton Corporation. 

Copyright Eaton Corporation, 1991-94. 
All rights reserved. 



* Filename: seq.shft.c96 (AutoSplit) 
* 

* Description: 

* The functions in this file will perform the required system 

* level operations for implementing Sequence Shift. 
* 

* Part Number: <none> 

* SLog: R:\aselect\vcs\seq_shft.c9v $ 

* Rev 1.0 12 May 1994 16:26:00 markyvech 

* Initial version 
* 

^ ....... . . . L ^ + + + + + 



/***************************************************************♦******** 



* Header files included. 



V 



# include <exec,h> /* executive information */ 

#include <c regs.h> /* KR internal registers V 

^include <wwslib.h> /* World Wide Software Library */ 

#include "cont sys.h" /* control system information */ 

#include M conjT939.h M /* Defines interface to engine communications info 4 

# include l 'con_o_s.h M /* control output signal information V 

#include "drl~cmds.h M /* drivel ine commands information */ 

#include "sel~gear.h M 

#include "shf'tbl.h" /* Contains information relative to engine */ 

#include M trn~tbl.h tt /* transmission table information */ 
#include "trns act.h" /* transmission information */ 



* #defines local to this file. 

/************************************************************************ 
* 

* publics. 

uchar sq_sh1; /* debug counter - delete later */ 
uchar sq_sh2; /* debug counter - delete later V 
uchar sq_sh3; /* debug counter - delete later */ 



* 

* Constants and variables declared by this file. 
* 

************************************************************************/ 

static uchar coastjnode; /* allows vehicle to coast in low gears */ 
static uint modest iraejxit; /* time to disengage or synchronize a gear V 



#pragma eject 



* Function: initial ize_sequence_shi ft 

* Description 



This function initializes the variables to be used in sequence_shift 



void initialize sequence_shif t(void) 

i 

shift_type = UPSHIFT; 
shift in_process = FALSE; 

> 



#pragma eject 



* 

* Function: shiftjnitiate 
* 

* Description: 

* This function begins the shift sequence by setting up the 

* transmission to pull to Neutral, commands the electronic engine 

* controller to go to zero torque and prepares the clutch to disengage 

* if required. 
* 

static void shift ini t iate(void) 
{ 

if (destination_gear < last_known_gear) /* determine shift type V 
C 

if (pet demand at cur sp > 5) 
shift~type =~POWER_DOWN_SH I FT ; 

else 

shift type = COAST DOWN SHIFT; 

> 

else 

shift_type = UPSHIFT; 



/* Attempt to get out of gear for 3 seconds then return fuel to driver 

/* 

if ( (engine_status • = ENGINEERED I PJ«O0E) SA <mode_time_out > 0) ) 

mode_time~out = 300; 
if < ( modest 7me_out > 0) && ( ! coast jnode) ) 

--mode time out; 

V 

mode_tiroe_out = 300; /* force value for now V 
/* initiate a normal shift sequence */ 

/* (do not request engine fueling with engine brake on) */ 
eng_brake_command = ENG_BRAKE_OFF; /* eng brake: zero torque */ 

if ((Ipf output speed < shf tbl ,min_output_spd) || 
(clutch_state == DISENGAGED) || 
(mode_time_out == 0) | | 
((destinat!on_gear < 4) && 
(coast_mode) && 

(accelerator_pedal_posi tion <= 5) && 
(shift type != UPSHIFT))) 

i 

engine commands = ENGINE JOL LOWER ; 

> 

else 
( 

engine_commands = ENGINEERED IP; /* engine: bring torque to zero * 

coastJSode = FALSE; 

> 

> 

#pragma eject 



* Function: synch ronize_gear 
• 

* Description: 

* This function assists the sychronizing of the transmission if 

* possible, by controlling input shaft speed through the use 

* of the clutch, power synchronizer, or inertia brake. It will 

* offset sync windows if the shift is taking longer than expected. 

* It will assist with engagement at rest if the clutch is dragging. 
* 

static void synchronize gear(void) 
C 

/* turn on engine brakes (J1939) if engine brake assisted shift is requested 

if Ceng brake assist) 

eng_bYake_command = ENG_BRAKE_FUll; 

else 

eng_brake_command = ENG_BRAKE_OFF; 
/* Attempt to engage for 6 seconds then return fuel control to the driver */ 

/* 

if C (engine_status 1= ENGI NE_SYNC_MOOE ) && ( modest ime_out > 0) ) 

mode time out = 600; 
if ( (mode_tTme_out > 0) && ( ! coastjnode) ) 

--mode time out; 

*/ 

mode_time_out = 600; /* force value for now */ 

if <<lpf output speed < shf tbl .min_output_spd) || 
<clutch_state == DISENGAGED) || 
(mode_time_out ==0) || 
<<destinatTon_gear < 4) && 
(coastjnode) && 

<acceleratorj>edalj>osition <= 5) && 
(shift type !* UPSHIFT))) 

C 

engine commands = ENGINE_FOLLOWER; 

> 

else 
i 

engine_commands = EHGINE_SYNC; 
coast mode = FALSE; 

> 



#pragma eject 



* Function: conf ira_shift 

* ~~ 

* Description: 

* This function finished the shift; shift_in_process is set FALSE. 
* 



static void confirm shift(void) 
( 

engine comnands = ENGINEJECOVERY; 
eng_brake_conmand = ENG_BRAKE_OFF; 
mode_time_out = 300; 
shift_in_process = FALSE; 
coastjnode = TRUE; 



/* engine: finish torque return 
/* eng brake: zero torque */ 
/* reset for next shift */ 



^pragma eject 



* Function: sequence_sh i f t 
« 

* Description: 

* This function calls the appropriate procedures to perform the 

* operations of Sequent e_Shi ft depending on the correct state of 

* the shift process. 
* 

void sequence shift(void) 
( 

if (destination gear « NULL_GEAR) /* system has reset: do not start a shift 

engine conmands = ENGINE FOLLOWER; 
eng brake command = ENG BRAKE IDLE; 

> 

else 

if (<transmissionj»sition == OUT OFJJEAR) && 
((engine status == ENGINE SYNC_MOOE) || 
(engine'status == ENGI NE_PRED I P_M00E ) ) ) /* forces call shif t_initiate() 

< 

sq^shl-M-; 

synchronize gear(); 

> 

else 

if (((engine status == ENGINE SYNC MODE) || 

(engine~status == ENGI NE_RECOVERY_KODE ) ) && 
(destination_gear == current_gearT && 
(transmission_position == I N_GEAR ) ) 

C 

sq_sh2+>; 
confirm shiftO; 

> 

else 

if (((destination gear != current_gear) && /* auto splitter */ 
(Low_speed_latch == FALSE) &&" 
(automat ic_sip ! = 0) && 
(transmissTon_position == I N_GEAR ) ) || 
((transmission_position == 0UT_0FJ3EAR) && /* manual shift */ \J 
(lowspeed latch == FALSE))) ~ 

( 

shift_initiate(); 
sq_sh3++; 

> 



* Unpublished and confidential. Mot to be reproduced, 

* disseminated, transferred or used without the prior 

* written consent of Eaton Corporation. 
* 

* Copyright Eaton Corporation, 1994. 

* All rights reserved. 



* Filename: tmr.acr.c96 (AutoSplit) 

* ~~ 

* Description: 

* This (nodules monitors and controls the transmission actions. 
* 

* Part Number: <none> 

* $Log: ??? $ 
* 

* Rev 1.0 3 May 1994 13:35:04 markyvech 

* Initial revision. 



* Header files included. 



# include <exec.h> 
#include <c_regs.h> 
# include <kr_sfr.h> 
#include <kr~def.h> 
#include <wwslib.h> 
#include "drl^cmds.h 11 
#include "trns_act.h" 
#include »trn_tbl.h" 
#include "calc^spd.h" 
#include "cont~sys.h" 
#include "sel gear.h" 
#include »conTl°39.h» 



/* executive information */ 

/* ICR internal register definitions 
/* defines the kr special function registers */ 
/* 80c196kr bits, constants, and structures */« 

/* engine control interface */ 
/* interface to this module */ 
/* transmission table */ 



* Variables declared by this file. 
* 

*************** 



register unsigned char transmission ^position; 

unsigned char low_speed_latch; 

unsigned char forward_last; 

unsigned char splitter_hi; 

unsigned char splitter_lo; 

unsigned char spl itter_tiraer; 

unsigned char splitter~within_sync; 

unsigned char aux_box; 

signed char g_ptr_old; 

signed char current_gear; 

signed char lastJcnown_gear; 

unsigned int gear_in_timer; 

unsigned int gear_out_timer; 

unsigned int abs_trans_sync_error; 

unsigned int trans_windowj:alc; 

signed int input~speed_modif ied; 

signed int trans_sync_error; 

signed int range_error; 

signed int range_cal; 

signed int splitter_tc; 

signed long isdgf; 

signed long gros; 

signed char g_ptr; 



#pragma eject 



/♦♦a***************************************** ********* 



*********** 



* #defines and constants local to this file. 



#define US PER LOOP 10000U 
tfdefine RKM_US>ER_L0OP 40000U 

static const uchar SPLITTER.LOJABLEC23] = 
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#pragma eject 



static const uchar sniTTER_TC_TABLEC23) » 
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>; 



#pragma eject 



/* 



ft***************************** 



* Function: Initialize_Trans_Action 
* 

* Description: 

* This function initializes those module variables that must be set to a 

* know state on power up or reset. 



void initialize trans action(void) 
{ 

gear_in_ timer = 200; 
gear_out_t imer = 200; 
g_ptr_old = 0; 
current_gear = 0; 
last_known_gear « 0; 
destination_gear = 0; 
transmission_position = OUT_0F_GEAR; 
low_speed_latch = TRUE; 
splTtter_To = 0; 
splitterjn = 0; 



#pragma eject 



* Function: deterwine.gear 
* 

* Description: . . 

* This function determines the current gear that the transmission 

* is in. When conditions are such that the current gear can not be 

* determined it will be set to a default ,(0). 
* 

* Note: When the error across the transmission is near rero for some 

* time for a given test gear then it will be deemed in that gear. 
* 

* error = input_spd/gf [gear] - grCgear) * os 



void determine gear(void) 
i 

#define BIN 8 
#define MAX ERR 
#def ine WINDOW 
#define GEAR IN.TIME.LEVER 
#define GEAR IN.TIME.AUTO 
#define GEAR OUT.TIME 
#def ine ERROR.FUOGE FACTOR 
/* 

signed long isdgf; 
signed long gros; 
signed char g_ptr; 
*/ 
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#if (0) 

g_ptr = -1; /* lowest reverse ratio */ 

/* isdgf = (((signed long) i nput.speed.f i Itered) * BIN_8) / trn.tbl .GF Cgj>tr ♦ GR_0FS3; */ 
bx = (signed int)( input_speed_7i Itered) ; 
"ex = BIN 8; 

"ax = trn.tbl. GF[g_ptr + GR.OFS1 ; 
asm mul .cxdx, _bx; 
asm div .cxdx, _ax; 
isdgf = ~cx; 

/* gros = (((signed long) output_speed.fi Itered) * trn_tbl.GRCg.ptr ♦ GR.OFS] ) / BINJ2; */ 
bx = (signed int)( output_speed.fi Itered ♦ ERROR.FUOGE.FACTOR); 
~cx = trn tbl.GR[g_ptr ♦ GR.OFS]"; 
"ax = BIN~8; 
asm mul _cxdx, _bx; 
asm div _cxdx, _ax; 
gros = .cx; 

trans.sync.error = (isdgf - gros); 
if (isdgf > gros) 

abs.trans.sync.error = (unsigned int)( isdgf - gros); 

else 

abs trans sync.error = (unsigned int)(gros - isdgf); 

#endif 

abs_trans_sync_error = MAX.ERR; 
trans_window_calc = 0; 

if (abs trans sync error > trarw.window.calc) /* if not in reverse, check for forward */ 
C 

g_ptr = 1 ♦ trn.tbl. highest.forward; 
abs trans sync error = MAX_ERR; 

while ((abs_trans_sync.error > trans_window_calc) && (g_ptr != 0)) 
C 

/* isdgf (((signed long) input_speed.fi Itered) * BIN_8) / trn.tbl. GF Cg_ptr * GR.OFSJ; V 
.bx = (signed i nt ) ( i nput_speed_f i Itered ); 
"cx = BIN 8; 

"ax = trn.tbl. GFCgj)tr * GR.OFS]; 
asm mul _cxdx, _bx; 
asm div _cxdx ( _ax; 
isdgf = _cx; 

/* gros » (((signed long) output speed.fi Itered) * trn.tbl. GR(gj>tr ♦ GR.OFS]) / BIN.12; 
bx = (signed int)( out put.speed.fi Itered ♦ ERROR.FUDGE.FACTOR); 
"ex » trn.tbl. GRtg_ptr ♦ GR.OFS]"; 



_ax = BIN_8; 
asm nul _cxdx, Jw; 
asm div ~cxdx, _ax; 
gros » _cx; 

trans_sync_error = isdgf - gros; 
if (isdgf > gros) 

abs_trans_sync_error a (intXisdgf - gros); 
else 

abs_trans_sync_error = (intXgros - isdgf); 
/* calculate trans sync error window based on gear pointer */ 



bx = WINDOW; 
"ex = BIN 8; 
~ax = trn~tbl.GFCg_ptr + GR_OFS]; 
asm mulu _cxdx ( _bx; 
asm divu ~cxdx, _ ax »" 
t rans_w i ndow_ca I c = _cx; 



/* BIN 0 */ 
/* BIN 8 */ 
/* BIN 8 */ 

/* make WINDOW BIN 8 V 

/* divide by front ration BIN 8 */ 

/* BIN 0 */ 



if <g_ptr == 0) /* if in neutral, force values */ 

< 

abs_trans_sync_error = MAX_ERR; 
trans_sync_error = HAX_ERR; 
trans~window_calc = 0; 
isdgf~= 0; 
gros = 0; 

> 

if ((abs trans sync error > trans window_calc) || /* Must have error for some V 
((g_ptr != current gear) && (current_gear != 0))) /* before neutral state is */ 
r /* recognized. */ 



if (gear_out timer == 0) 
C 

transmission_position = 0UT_0F_GEAR; 
current gear = 0; 

> 



else 

gear out timer--; 

> 

else 

gear_out_timer = GEAR_0UT JIME; 



if <(g_ptr != gj)tr_old) || (g_ptr == 0) || 
((accelerator_pedaljx)sition < 5) && 
(input speed < 800) && 
(low_speed_latch == FALSE))) 

if ((engine commands == ENGINE_SYNC) || 
(engine'eommands == ENGINEERED IP)) 

< 

if (shift init type == AUTO) 

gear_in~timer = GEAR_I N_T I ME_AUTO; 
else 

gear in timer = GEARJM_TINE_LEVER; 

> 



/* if not in gear, init gear in timer. 

/* Rule out picking a gear when coasting 

/* down in neutral and no throttle. 

/* (Found that idle speed and output speed 

/* would natch a gear even when in neutral.) 



else 

if (gear in timer « 0) 
< 

current_gear = g_ptr; 
last_known_gear = gjptr; 
transmissionjx)sition = I N_GEAR ; 

if ((gos current gear > (downshift j»int ♦ 100)) && 
(low'speed latch == TRUE)) 

C 

low_speed_latch = FALSE; 

destination_gear = current_gear; 

dest ination~gear_selected = current_gear; 

desired_gear = current_gear; 

lowest forward = current_gear; 

> 

else 



if (*low_speed_latch == TRUE) 

destination_gear a lowest_forward; /* was set to 1 

destination~gear_selected~* lowest_forward; /* was set to 1 
desired_gear » lowest_forward; /* was set to 1 

shift in ^process * FALSE; 

> 

> 

if (last known_gear > 0) 

forward_last~» TRUE; 
else 

forward last = FALSE; 

> 

else 

gear_in_timer--; 
g_ptr_old = g_ptr ; 

if (output speed filtered < 80) /* If stopped - current _gear = first. 
< ' 
current_gear = 0 ; 

transmission_position = 0UT_0F_GEAR; 
low speed latch = TRUE; 

> 

> 



/* Record REV/ FOR data for 
/* use in the select_gear 
/* module. 



#pragma eject 



* Function: detennine_range_status 
* 

* Description: 

* This function determines the status the of range. 
* 

* rng_err = rear_counter_spd - (range_ratio * output_spd) 

* ~" 

* res = 54/21 * 44 * os (for low range) 
* 

* res = 42/51 * 44 * os (for high range) 



void determine range_status(void) 
C 

#define BIN 12 4096 /* 2 bin 12 V 

#define HI RANGE GEAR 7 

#define uf RANCE~CAL 10532 /* 54/21 BIN 12 V 

#define HI~RANGE~CAL 3373 /* 42/51 BIN 12 V 

#def ine RANGE WINDOW POS 30 /* 30 RPM */ 

#define RANGEJrflNDOWJlEG -30 /* -30 RPM V 

if (destination gear >= HI_RANGE_GEAR) 

range_cal = hT_RANGE_CAL; 
else 

range_cal = 10_RANGE_CAL; 

range error =(((aux speed * BINJ2) 

- (range_cal * output_speed_f i I tered) )/BIN_12); 

if ((range error > RANGE WINDOW_POS) || (rangejirror < RANGE_W I ND OW_N EG)) 
aux_box = OUT_OF_GEAR ;"~ 

else 

aux_box = IN_GEAR; 



#pragma eject 



* Function: detennine_splitter 
* 

* Description: 

* This function determines the correct state for the splitter. 

* Once the transmission is in gear both splitter solenoids are turned off. 



/* 80 RPM */ 
/* -80 RPM */ 
/* 200 MSEC */ 



if (engine status == ENGINEERED I PJ4CDE) 

splitter~timer = SPLITTER_TIME; 
else 

if (splitter_timer > 0) 
splitter_tTmer--; 



splitter_tc = SPL I TTER_TC_TABLE [dest i nat i on_gear ♦ GR_0F$]; 

input speed modified = (signed int)( input_speed_f i Itered) ♦ 

(input_speed_accel_filtered/(1000/splitter_tc>); 

if ((input speed modified < (gos_signed ♦ SPLTR_SYNC_OFFSET_POS)) && 
(input"speed~modified > (gos_signed ♦ SPLTR_SYNC_OFFSET_NEG))) 
splitter3within_sync = TRUE; 
else 

splitter_within_sync = FALSE; 



if ((splitter_timer > 0) | | 

((transmissionj»sition == IN GEAR) && /* debug - delete later * 

(shiftJnj>rocess == FALSE)) || /* debug - delete later * 

(low_speed_Latch == TRUE) || 

(engine_status == ENG I NE_REC0VER Y_M00E ) || 

((shift init type == MANUAL) U 
(engines tat us == ENGI NE_SYNC_MODE ) ) || 

((shift init type == AUTO) && 
(engine_status == ENG I NE_SYNC_MOOE ) && 
(splitter within_sync == TRUE))) 

C 

splitter hi = SPLITTER HI TABLE [dest i nat ion_gear ♦ GR_OFS]; 
splitter~lo * SPLITTERJ.O~TABLECdestination_gear ♦ GR_0FS]; 

> 

else 
< 

splitterju » OFF; 
splitter"lo = OFF; 

> 

> 



void determine splitter_state(void) 

#define SPLTR SYNC OFFSET J>OS 80 
#define SPLTR~SYNC~0FFSET MEG -80 
#define SPLITTER tTmE 20 



#pragma eject 



* Function: Transmission_Action 
* 

* Description: 

* This funtion controls the states of the system ouput devices. 



void transmission action(void) 

C 

initial ize_trans_action<); 

x start_periodic(); 

while (1) 

< 

determine_gear<); 
determine_range_status( ); 
determi ne~spl i tter_state( ) ; 

x_sync_peri odi c<USJ>ER J.OOP) ; 



/* initialize variables V 



/* calculate the current gear V 

/* determine range state */ 

/* determine correct state for splitter */ 



x_end_periodic(); 
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